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CGTPIF  Programmer ' s  Guide 


A.l 


Introduction 


;GTPIF  is  a  controller  design  progreun  which  exe¬ 
cutes  interactively.  Three  design  paths  are  offered: 

(1)  design  of  a  Proportional-plus-integral  (PI)  regulator 
via  linear-quadratic  (LQ)  methodology;  (2)  design  of  a 
Command  Generator  Tracker,  either  open-loop  (CGT)  or 
closed-loop  (CGT/PI);  and  (3)  design  of  a  Kalman  filter 
(KF) .  These  three  designs  are  components  of  a  final  con¬ 
troller  implemented  as  a  Command  Generator  Tracker,  with  an 
inner-loop  proportional -plus- integral  regulator,  and  a 
Kalman  filter  for  state  estimation  (CGT/PI/KF) .  For  each 
design  path  there  is  a  corresponding  set  of  routines  to 
evaluate  the  quality  of  the  design  achieved. 

The  program  is  written  in  FORTRAN  IV  and  consists 
of  about  2500  lines  of  source  code.  In  addition,  numerous 
routines  are  employed  from  a  library  of  matrix  routines 
described  in  Reference  24.  Since  the  resulting  program  is 
large  both  in  code  and  in  memory  utilization  for  array 
storage,  direct  and  complete  loading  of  the  progrcun  exceeds 
memory  limits  for  interactive  execution  on  the  ASD  CYBER 
coii:?)uter  system.  A  technique  referred  to  as  "segmentation" 
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is  employed  to  provide  selective  loading  of  routines  dur¬ 
ing  execution  so  that  memory  usage  remains  within  the 
limits  for  interactive  execution. 

This  guide  first  discusses  various  general  aspects 
of  the  program  relevant  to  a  programmer  wishing  to  under¬ 
stand  the  code  and  wishing  to  obtain  an  executable  object 
file.  Later  sections  discuss  the  specific  execution  paths 
and  the  computations  performed  by  each  routine. 

A. 2  Program  Structure 

All  of  CGTPIF's  execution  logic  and  computations 
are  embodied  in  a  large  set  of  routines  which  require  no 
modification  in  order  to  apply  the  program  to  various  dif¬ 
ferent  specific  design  problems.  These  invariant  routines 
are  referred  to  here  collectively  as  CGTPIF  SUBS.  Among 
these  routines,  a  single  subroutine,  CGTXQ,  serves  as  the 
overall  executive  for  program  execution. 

Additional  routines  comprising  CGTPIF  are  the  main 
program  routine  (MAIN)  and  various  optional  user-provided 
routines.  MAIN  simply  defines  temporary  file  names,  allo¬ 
cates  total  array  storage,  then  calls  CGTXQ.  CGTXQ  then 
determines  all  execution  options  and  calls  the  appropriate 
routines  of  CGTPIF  SUBS.  The  optional  routines  are  called 
from  within  the  CGTPIF  SUBS  routines  (at  the  user's  dis¬ 
cretion)  ,  and  if  not  specifically  needed  for  the  design  of 
interest  may  be  omitted  (i.e.,  the  user  need  not  provide 
"dummy"  subroutines) .  IF  CGTPIF  is  directed  by  the  user  to 


call  such  optional  routines  but  which  the  user  has  not  pro¬ 
vided,  dununy  routines  within  CGTPIF  SUBS  are  called.  These 
dununy  routines  allow  the  call  to  be  completed  and  signal 
CGTPIF  that  functional  routines  do  not  exist  in  the  object 
file.  Thus  execution  of  the  program  is  not  affected  if  the 
user  directs  execution  of  optional  routines  that  he  has  not 
implemented. 

The  available  executable  object  file  for  CGTPIF 
provides  specific  array  allocations  and  can  handle  systems 
with  states  and  other  vector  variables  dimensioned  in  the 
range  of  10-20,  approximately  (the  specific  dimensionali¬ 
ties  are  given  in  a  later  section) .  In  many  cases  the 
available  CGTPIF  will  be  directly  applicable  to  a  variety 
of  different  problems  without  modification.  However,  if 
the  memory  allocation  is  to  be  changed  and/or  if  emy  of  the 
optional  routines  are  to  be  implemented,  then  these  will 
require  compilation.  The  CGTPIF  SUBS  routines  would  require 
no  modification  under  these  circumstances. 

The  general  structure  of  CGTPIF  is  shown  in 
Figure  A-1.  The  blocks  emanating  from  CGTXQ  comprise  the 
primary  computational  components  of  the  program.  At  any 
given  instant  during  program  execution,  the  routines 
actually  loaded  in  memory  are  MAIN,  subroutine  CGTXQ,  and 
the  subroutines  associated  with  a  single  computational 
block  called  by  CGTXQ.  In  addition,  certain  routines 
utilized  by  several  different  computational  blocks  are 
loaded  in  conjunction  with  CGTXQ. 
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A  :  Establish  Dyneunics  Model 

A':  Optional  User  Routines 

B  ;  Controller  Setup  Computations 
C  :  Design  PI  Regulator 

D  :  Design  CGT  or  CGT/PI  Controller 

E  :  Evaluate  Controller 

F  ;  Design  Kalman  Filter 

G  :  Evaluate  Filter 


Fig.  A-1.  CGTPIF  General  Structure 


4 


t 


A. 3  Segmentation  (Ref  13) 

As  mentioned  above,  only  certain  routines  of 
CGTPIF  are  actually  in  memory  at  any  time  during  execution. 
This  selective  loading  is  achieved  using  a  CYBER  loader 
option  termed  "Segmentation." 

Segmentation  is  achieved  using  Job  Control  Language 
and  segmentation  directives.  Source  code  requires  no  modi¬ 
fication,  and  is  simply  compiled  in  the  usual  manner  but 
without  immediate  execution.  The  object  files  for  all 
source  code  and  all  library  routines  are  then  manipulated 
according  to  the  segmentation  directives  to  create  a  seg¬ 
mented  object  file.  This  object  file  may  then  be  executed 
like  any  other  executable  file. 

As  the  segmented  file  executes,  segments  of  object 
code  are  loaded  and  unloaded  to  achieve  the  memory-resident 
program  structure  defined  by  the  segmentation  directives. 
All  loader  operations  are  performed  automatically.  For  the 
user,  execution  proceeds  as  though  the  entire  program  were 
resident  at  all  times. 

For  CGTPIF,  the  Job  Control  commands  and  the  seg¬ 
mentation  directives  needed  to  achieve  a  segmented  exe¬ 
cutable  object  file  are  invariant.  A  listing  of  the  job 
commands  is  given  in  Appendix  E.  More  detail  on  segmenta¬ 
tion  may  be  found  in  Reference  13. 
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A. 4  Use  of  Library  Routines 

Routines  described  in  Reference  24  are  maintained 
in  a  program  library  in  object  form.  CGTPIF  employs  mamy 
of  the  'LIBRARY*  routines  in  performing  necessary  computa¬ 
tions. 

The  LIBRARY  routines  execute  very  efficiently. 

Array  subscripting  is  single -indexed  to  reduce  the  over¬ 
head  execution  time  incurred  simply  in  computing  array 
element  addresses.  However,  as  a  byproduct  of  this  single¬ 
indexing  technique  and  the  array  storage  mechanism  of 
FORTRAN,  the  row  dimension  allocation  within  which  arrays 
are  stored  must  be  the  same  for  all  arrays  used  by  a 
library  subroutine  call  (in  some  cases  in  which  matrix 
transposes  are  involved,  a  column  dimensioning  constraint 
is  also  imposed) .  The  routines  included  in  the  CGTPIF  SUBS 
package  accommodate  these  requirements  on  the  effective  row/ 
column  array  allocations  in  each  case  that  LIBRARY  routines 
are  employed . 

Three  named  common  blocks  of  CGTPIF  are  included  to 
effect  communication  with  the  LIBRARY  routines:  /MAINl/, 
/MAIN2/,  and  /INOU/.  These  provide  two  teit5)orary  arrays, 
two  parameters  related  to  the  row  dimension  used  for  array 
storage,  cuid  three  parameters  defining  files  to  be  used 
for  input/output  (I/O) .  Later  sections  of  this  guide  dis¬ 
cuss  these  and  all  other  common  blocks  in  detail. 
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A. 5 
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Array  Storage 

A  significant  characteristic  of  CGTPIP  is  its 
applicability  to  problems  having  a  large  variety  of  dimen¬ 
sionalities  with  system  orders  as  great  as  10  to  20 .  This 
is  achieved  by  efficient  techniques  for  array  storage, 
adaptive  addressing  of  individual  arrays,  and  careful  coding 
to  avoid  generating  unnecessary  temporary  storage  areas. 

The  resulting  code  is  not  typical  of  the  coding  frequently 
encountered  in  matrix  routines  but  is  not  in  itself 
especially  difficult  to  understand. 

The  basic  principle  in  the  array  storage  technique 
is  single.  A  small  nuirber  of  one-dimensional  arrays  are 
allocated  corresponding  to  specific  computational  elements 
of  the  program.  Within  each  allocated  vector,  individual 
arrays  are  stacked  linearly  according  to  the  standard 
FORTRAN  convention  (storage  by  columns) .  Each  array 
occupies  only  as  many  storage  locations  as  required  to  con¬ 
tain  all  its  elements,  and  for  each  a  starting  address  in 
the  appropriate  linear  stack  is  computed.  Any  array  then 
can  be  located  through  its  starting  address  in  the  larger 
vector.  Thus  within  a  given  total  allocation  for  each  com¬ 
putational  element,  individual  arrays  of  many  different  spe¬ 
cific  dimensions  can  be  stored.  Each  array  used  cem  be 
considered  "full"  (the  "allocated"  dimensions  and  actual 
dimensions  are  identical) . 

The  usual  method  for  achieving  variable  array  dimen¬ 
sioning  involves  specific  fixed  dimensioning  of  many 
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individual  arrays.  Although  this  corresponds  more  with  the 
ordinary  conception  of  arrays  and  mcikes  the  code  sin5>le  to 
write,  there  are  disadvantages.  Often  the  overall  problem 
size  vAiich  can  be  handled  is  smaller  since  all  allocations 
assume  the  maximum  value  of  every  specified  dimension  is 
simultaneously  attained.  Also,  problems  having  different 
sets  of  dimensions  inconsistent  with  the  fixed  dimensions 
may  cause  individual  array  allocations  to  be  exceeded  vdiile 
other  arrays  have  enough  excess  storage  locations  to  accom¬ 
modate  the  need.  But  that  storage  is  not  free  to  be  por¬ 
tioned  out  among  the  arrays  suffering  the  short-fall  and 
the  problem  cannot  be  accommodated. 

In  CGTPIF,  many  of  the  matrix  computations  work 
with  arrays  which  are  "in  place"  in  the  large  vector 
storage  areas.  In  cases  in  which  augmented  matrices  are 
formed,  arrays  may  be  moved  from  permanent  storage  to 
form  a  partition  of  a  new  matrix.  Also,  in  using  the 
LIBRARY  routines  it  is  sometimes  necessary  to  move  arrays 
from  their  full  storage  mode  to  other  temporary  storage  of 
larger  row  dimension.  Finally,  other  arrays  are  soite times 
moved  from  partitions  of  larger  arrays  to  permanent  full 
storage . 

Figure  A-2  illustrates  several  asp>ects  of  array 
storage  using  a  model  of  a  partitioned  matrix  M.  While  it 
is  represented  in  the  figure  as  two-dimensional,  storage 
is  actually  one-dimensional  and  CGTPIF  works  with  single 
value  addresses  within  M.  Note  that  M  is  in  full  storage 
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n-by-m 
n-by-p 
r-by-m 
r-by-p 
(n+r) -by-(m+p) 


Fig.  A-2.  Partitioned  Matrix  M 


mode  and  is  stored  in  the  manner  typical  of  variable 
dimensioning  (matrix  of  dimension  n-by-m  stored  in  array 
M  allocated  (n+r) -by- (m+p)  locations). 

Suppose  that  array  M  is  itself  stored  within  a 
larger  vector  V  and  that  the  first  element  of  M  is  at  loca¬ 
tion  LM  in  V.  Columns  of  M  are  stored  in  consecutive 
locations  in  V.  Figure  A-3  shows  M*  s  first  column  within 
V.  Note  the  following  addresses  are  equivalent: 

ADDR(V(LM)  )=ADDR(M(1)  )=ADDR(Aj^(l,l)  ) 

ADDR(V(LM+n-l) )=ADDR(M(n)  )  =  ADDR(A^ (n , 1) ) 
ADDR(V(LM+n) ) =ADDR(M(n+l) ) =ADDR(A2 (1 , 1) ) 
ADDR(V(LM+n+r-l) )=ADDR(M(n+r) )=ADDR(A3 (r,l) ) 
ADDR(V(LM+n+r)  )=ADDR(M(n+r+l)  )=ADDR(Aj^(l,2)  )  (A-1) 

where  'ADDR'  is  an  address  function  giving  the  absolute 
memory  storage  location. 

Similarly,  the  addresses  of  all  elements  of  matrices 
h.2’  —3'  —4  equivalents  which  specify  the  cor¬ 

responding  address  within  V  and  M.  In  the  moving  of  arrays 
mentioned  previously  and  in  computations  involving  arrays 
it  is  necessary  that  such  equivalences  among  addresses  be 
readily  determined.  CGTPIF  includes  several  routines  spe¬ 
cifically  dealing  with  such  array  manipulations. 

Programmers  often  encounter  difficulties  in  working 
with  arrays  that  are  not  fixed  in  size.  The  array  storage 
techniques  employed  in  CGTPIF  are  readily  understandable 
if  careful  thought  is  given  to  the  actual  arrangement  of 
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Fig.  A-3.  Column  1  of  N  within  V 


arrays  within  progrcun  memory.  If  one  has  not  previously 
considered  such  aspects  of  array  storage  in  FORTRAN  programs, 
it  may  be  useful  to  determine  various  address  equivalences 
among  A2,  A^,  M,  and  V  of  Figures  A-2  euid  A-3. 

A. 6  Common  Blocks 

CGTPIF  uses  named  Common  blocks  exclusively.  A 
total  of  twenty-five  Commons  are  used.  Some  provide  commvmi- 
cation  with  the  LIBRARY  routines,  others  communicate  general 
program  information,  others  provide  tenporary  array  storage, 
and  others  are  associated  with  specific  computational  ele¬ 
ments.  The  last-mentioned  Commons  will  be  discussed  in 
groupings  according  to  the  computational  element  to  vdiich 
each  group  pertains.  The  elements  of  each  Common  are  given 
here  but  will  be  described  by  type  only  (integer,  real, 
scalar,  vector) .  Information  about  array  dimensioning  is 
given  in  the  discussion  of  the  ’MAIN*  routine.  Specific 
definition  of  the  elements  of  each  Common  are  given  in 
descriptions  of  the  routines  of  CGTPIF  SUBS. 

A. 6.1  LIBRARY  Commons .  Three  Common  blocks  com¬ 
municate  with  thd  LIBRARY  routines: 

C0MM0N/MAIN1/NDIM,NDIM1 ,C0M1 

COMMON /MAIN 2 / COM2 

COMMON/ INOU/KIN,KOUT,KPUNCH 

NDIM,  NDIMl,  KIN,  KOUT,  and  KPUNCH  are  integer  scalars. 

COMl  and  COM2  are  real  arrays  providing  temporary  storage, 
and  are  used  occasionally  for  this  purpose  by  CGTPIF  also. 


Further  details  are  given  in  the  discussion  of  the  MAIN 
program. 


A. 6. 2  General  Commons.  Two  Commons  communicate 
general  information; 

COMMON/DESIGN/NVCOM, TSAMP , LFLRPI , LFLCGT , 

LFLKF , LTEVAL , LABORT 

COMMON /FILES/KSAVE , KDATA,KPLOT , KLIST , KTERM 
All  the  variables  are  scalar  and  all  but  TSAMP  are  integer; 
TSAMP  is  a  real.  Further  detail  about  the  elements  of  each 
Common  are  included  in  the  discussions  of  routines  CGTXQ 
and  MAIN  for  /DESIGN/  and  /FILES/,  respectively. 

A. 6. 3  Temporary  Storage  Commons .  Three  Commons 
provide  arrays  for  temporary  storage; 

COMMON / SY  SMTX / N VSM , SM 

COMMON/ ZMTXl/NVZM, ZMl 

COMMON/ZMTX2/ZM2 

NVSM  and  NVZM  are  integer  scalars.  SM,  ZMl,  and  ZM2  are 
real  arrays.  The  dimensioning  of  the  arrays  is  discussed 
in  the  description  of  MAIN. 

A. 6. 4.  Computational  Element  Commons .  Sets  of 
Common  blocks  are  associated  with  computational  elements 
A,  B,  C,  D,  and  F  of  Figure  A-1.  More  detail  about  the 
elements  of  each  Common  is  given  in  the  later  sections 
describing  the  routines  of  each  corresponding  computational 
element . 
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A. 6. 4.1  Set  A:  Establish  Dynamics  Model.  Three 


different  dynamics  models  may  be  employed — for  each,  three 
Common  blocks  are  used. 

Design  Model : 

COMMON /NDIMD/NND , NRD , NPD , NMD , NDD , NWD , NWDD , NPLD , 
NWPNWD,NNPR 

COMMON / LOCD / LAP , LGP , LPH I,LBD,LEX,LPHD,LQ, LQN , LQD , 
LC , LDY , LEY , LHP , LR 

COMMON/DSNMTX/NVDM, NODY , NOEY , DM 

Truth  Model : 

COMMON/NDIMT/NNT ,NRT , NMT , NWT 

COMMON/LOCT/LPHT , LBDT , LQDT , LHT , LRT , LTDT , LTNT 
COMMON/TRUMTX/NVTM, TM 
Command  Model : 

COMMON/NDIMC/NNC ,NRC ,NPC 
COMMON / LOCC / LPHC , LBDC , LCC , LDC 
COMMON/CMDMTX/NVCM,NEWCM,NODC , CM 
DM,  TM,  and  CM  are  real  arrays.  All  other  variables  are 
integer  scalars.  The  various  models  are  discussed  in  the 
next  section  of  this  guide. 

A. 6. 4. 2  Set  B;  Controller  Setup.  A  pair  of 
Commons  is  associated  with  the  setup  computations  for 
the  controller; 

COMMON / LCNTRL /LP I11,LPI12,LPI21,LPI22, LPHDL , LBDL 
COMMON/CONTROL/NVCTL ,CTL 

CTL  is  a  real  array.  All  other  variables  are  integer 


scalars 


A. 6. 4. 3  Set  C:  Design  PI  Regulator .  A  pair  of 
Commons  is  used  for  the  PI  design: 

COMMON/LREGPI /LXDW , LODW , LPHCL , LKX , LKZ 
COMMON/CREGPI/NVRPI , RPI 

RPI  is  a  real  array .  All  other  variables  are  integer 
scalars . 


A. 6. 4. 4  Set  D:  Design  CGT  or  CGT/PI .  The  design 

of  the  CGT  or  CGT/PI  controller  uses  a  pair  of  Commons: 

COMMON/LCGT/LAl 1 , LAl 3 , LA2 1 , LA2  3 , LAI 2 , LA2  2 , LKXAl 1 , 
LKXA12,LKXA13 

COMMON/CCGT/NVCGT ,CGT 

CGT  is  a  real  array.  All  other  variables  are  integer 
scalars. 


A. 6. 4. 5  Set  F:  Design  Kalman  Filter.  The  design 
of  the  Kalman  filter  uses  a  pair  of  Commons: 

COMMON / LKF / LEADSN ,LFLTRK , LFCOV 
COMMON/CKF/NVFLT , FLT 

FLT  is  a  real  array.  All  other  variables  are  integer 
scalars . 

A. 7  Dynamics  Models 

CGTPIF  employs  three  time-invariant  dynamics  models 
for  computations:  a  "design"  model,  a  "truth"  model,  and  a 
"command"  model.  Each  model  is  defined  initially  as  a 
continuous- time  system,  then  is  discretized  by  CGTPIF. 

Any  of  the  models  may  be  established  by  user-provided 
subroutines,  if  desired.  This  section  defines  each  model; 
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a  later  section  discussing  conputational  element  A  describes 
the  manner  in  which  the  models  may  be  entered  into  CGTPIF. 

A. 7.1  Design  Model .  The  design  model  consists  of 
a  system  state  differential  equation,  a  disturbance  state 
differential  equation,  an  output  equation,  and  a  measure¬ 
ment  equation,  as  follow: 

i(t)  =  ^(t)  +  Bu(t)  +  E^n^(t)  +  ^(t)  (A-2a) 

=  A^n^(t)  +  G^w^(t)  (A-2b) 

y(t)  =  Cx(t)  +  DyU(t)  +  E^^n^Ct)  (A-2c) 

z(t.)  =  Hx(t.)  +  H„n^(tJ  +  v(t.)  (A-2d) 

The  under-tilde  denotes  the  variable  as  being  modeled  as  a 
random  process,  x  and  are  the  Gaussian  system  and  dis¬ 
turbance  state  vectors  respectively;  w  and  ^  are  indepen¬ 
dent  stationary  zero-mean  white  Gaussian  noises  with 
covariances 

E{w(t)w’^(t+T)  }  «  Q6(t)  (A-3a) 

E{w^(t)^  (t+T)}  =  Qjj6(t)  (A- 3b) 

The  vectors  ^  and  z  are  the  output  and  measurement  vectors, 
respectively,  y  is  stationary  zero-mean  white  Gaussian 
discrete-time  noise  independent  of  both  w  and  w^  and  of 
covariance 

E{y(t^)y'^(tj)  }  =*  (A-4) 
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The  dimensionalities  for  the  design  model  are, 

n  s  number  of  system  states 

r  =  number  of  system  inputs 

p  =  number  of  system  outputs 

m  =  number  of  system  measurements 

d  =  number  of  disturbance  states 

w  =  number  of  independent  system  noises 

Wjj  =  number  of  independent  disturbance  noises  (A- 5) 

CGTPIF  requires  that  the  number  of  system  inputs  and  out¬ 
puts  be  equal:  p=r.  Also,  the  number  of  disturbance  states 
cannot  be  greater  than  the  number  of  system  states:  d£n 
(due  to  setup  for  solution  of  the  CGT  equations  of  Section 
A. 11. 5,  in  which  the  maximum  row  dimension  is  assumed  to  be  n)  . 

The  dimensions  of  the  matrices  defining  the  design 
model  are  given  in  row,  column  specification  as 


A  : 

n-by-n 

B  : 

n-by-r 

E  : 

— X 

n-by-d 

G  : 

n-by-w 

Q  • 

w-by-w 

C  : 

p-by-n 

p-by-r 

p-by-d 

H  : 

m-by-n 

«n  = 

m-by-d 

R  : 

m-by-m 

^n^ 

d-by-d 
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:  d-by-Wjj 


(A-6) 


Qn  :  Wjj-by-Wjj 

The  design  model  is  a  dynamic  model  of  the  system 
for  v^ich  the  controller  is  to  be  designed.  The  Kalman 
filter  will  estimate  the  states  of  the  design  model  and 
these  will  be  employed  by  the  controller  for  feedforward 
and  feedback  control. 


A.  7.2  Truth  Model .  The  truth  model  consists  of  a 
state  differential  equation,  a  measurement  equation,  and  two 
equations  relating  the  system  and  disturbance  states  of  the 
design  model  to  the  truth  model  states,  as  follow; 


*^(t) 

(A-7a) 

ftlti) 

(A- 7b) 

x"(t) 

(A-7c) 

B'd(t) 

(A-7d) 

with  the  truth  model  state  and  modeled  as  a  Gaussian 
random  process,  x'  and  n^  correspond  to  states  of  the 
design  model  (equation  (A-2)).  and  are  independent 

stationary  zero-mean  white  Gaussian  continuous  and  discrete¬ 
time  noises  with  covariances 


E{w^(t)w^(t+T) }  =  Q^6(t) 

(A-8a) 

(A-8b) 
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The  dimensionalities  for  the  truth  model  are, 
n^  =  number  of  system  states 
r^  =  number  of  system  inputs 
irVj,  =  number  of  system  measurements 

=  number  of  independent  noises  (A-9) 

CGTPIF  requires  that  the  numbers  of  measurements  and  of 
inputs  be  equal  for  both  truth  and  design  models;  nVj,  =  m 
and  r^  =  r. 

The  dimensions  of  the  matrices  defining  the  truth 
model  are  given  in  row,  column  specification  as 


-t  ' 

n„-by-n_ 
T  JT  T 

®t  ^ 

^t  = 

n^-by-w^ 

2t  = 

w^-by-w^ 

St  ^ 

m,j,-by-n^ 

^t  ^ 

m^-by-m^ 

-DT* 

n-by-n^ 

-NT* 

d-by-n^ 

The  truth  model  represents  the  same  dynamic  system 
as  the  design  model,  but  generally  may  be  of  greater  dimen¬ 
sion  and  complexity.  It  is  intended  to  provide  as  complete 
and  accurate  a  description  as  possible  of  the  system 
dynamics,  consistent  with  the  design  objectives. 

A. 7. 3  Command  Model .  The  command  model  is  defined 
by  a  state  differential  equation  and  an  output  equation: 
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i  (t)  =  A  X  (t)  +  Bu^(t)  (A-lla) 

— m  — m— in  — m— m 

V  (t)  =  C  X  (t)  +  D  u  (t)  (A-llb) 

■'-m  — m— m  — m— m 

The  dimensionalities  of  the  command  model  are, 
n„  =  number  of  model  states 

M 

rj^  =  number  of  model  inputs 

=  number  of  model  outputs  (A-12) 


CGTPIF  requires  that  the  nuitbers  of  outputs  of  the  command 
and  design  models  be  equal:  Pj^j  =  p.  Also,  the  number  of 
command  model  states  cannot  be  greater  than  the  number  of 
system  states  of  the  design  model:  (due  to  setup  for 

solution  of  the  CGT  equation  of  Section  A. 11. 5  in  which  the 
maximum  row  dimension  is  assumed  to  be  n) . 

The  dimensions  of  the  matrices  defining  the  command 
model  are  given  in  row,  column  specification  as 


An,- 
— m 

— m 

— m 

— m 

p„-t>y-r„ 

(A-13) 


The  command  model  represents  the  (tynamics  that  the 
controlled  system  is  intended  to  follow.  Typically  it  is 
of  relatively  low  dimension  since  the  desired  dynamics 
are  usually  characterized  by  first-  or  second-order  descrip 


tions. 


A. 8  File  Usage 

In  addition  to  the  input/output  (I/O)  communication 
directly  with  the  user  terminal,  CGTPIF  uses  four  files  for 
I/O.  The  'DATA'  file  is  used  for  input,  files  'SAVE'  and 
'LIST'  are  used  for  output,  and  file  'PLOT'  is  used  for 
input  and  output.  Because  of  the  close  relationship  between 
the  SAVE  and  DATA  files,  they  are  discussed  first. 

A. 8.1  SAVE  File .  During  program  execution  the  user 
may  direct  CGTPIF  to  write  any  of  the  system  models  to  the 
SAVE  file.  If  the  PI  design  path  has  been  executed,  then 
the  existing  sets  of  PI  gains  are  automatically  written  to 
SAVE  just  prior  to  progreun  termination.  An  integer  code 
number  written  along  with  each  output  to  the  file  identi¬ 
fies  each  set  of  data;  the  design,  command,  and  truth  models 
are  codes  1,  2,  and  3,  respectively;  the  PI  gains  are  code  4 . 
A  code  of  -1  is  written  to  indicate  that  no  more  data  is 
on  the  file. 

A. 8. 2  DATA  File.  A  previously  created  SAVE  file 
may  be  given  the  local  file  name  DATA.  During  program  exe¬ 
cution,  CGTPIF  can  be  directed  to  read  system  models  and  PI 
gains  from  DATA  as  needed.  If  the  data  sought  by  CGTPIF 
is  not  on  the  DATA  file,  a  message  is  written  to  the 
terminal  and  execution  proceeds  on  an  alternative  path, 
as  appropriate. 
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A. 8. 3  LIST  File .  During  program  execution  results 
of  computations  are  output  to  the  LIST  file  under  format 
direction.  After  progrcim  execution  is  stopped,  LIST  may 
be  routed  to  a  line-printer  for  listing. 

A. 8. 4  PLOT  File.  The  PLOT  file  is  used  by  CGTPIF 
during  controller  and  filter  evaluations.  Variables 
derived  from  time-response  simulations  are  written  to  PLOT 
at  each  time  sample .  When  the  time-response  run  is  com¬ 
plete,  selected  variables  are  read  from  PLOT  to  generate 
line-printer  plots  of  the  results. 

A. 9  Description  of  Routine  'MAIN ' 

MAIN  specifies  files  to  be  used  and  their  FORTRAN 
unit  designations  (e.g.,  'INPUT'  is  unit  5);  it  allocates 
all  array  dimensions  for  the  Common  blocks  and  calls  sub¬ 
routine  CGTXQ.  A  listing  of  MAIN  is  in  Appendix  D. 

The  appropriate  unit  designations  for  files  SAVE, 
DATA,  PLOT,  LIST,  and  of  the  user  terminal  are  set  in  the 
variables  KSAVE,  KDATA,  KPLOT,  KLIST,  and  KTERM,  respec¬ 
tively  of  the  /FILES/  Common.  The  variable  KIN  of  /INOU/ 
is  set  to  the  unit  designator  for  the  INPUT  file. 

Array  allocation  requires  two  steps;  arrays  are 
allocated  by  specifying  a  vector  length  for  each  array  in 
its  common  declaration;  the  length  of  each  array  is  then 
set  in  an  appropriate  integer  variable  which  communicates 
array  allocations  to  CGTPIF  SUBS  through  the  Commons. 


Denoting  the  integer  vector  lengths  allocated  for 

the  various  individual  Conunon  arrays  as  n^^,  n2,  n^, 

niQ/  arrays  are  allocated  as  follows: 

C0MM0N/MAIN1/NDIM,NDIM1  ,C0M1  (n^^) 

COMMON/MAIN2/COM2  (n^^) 

COMMON/SYSMTX/N VSM, SM ( n  2 ) 

COMMON/ ZMTXl/NVZM, ZMl (n^) 

COMMON/ ZMTX 2 /ZM2 (n^) 

COMMON /DSNMTX/NVDM , NODY , NOEY , DM ( n^ ) 

COMMON /CMDMTX/ NVCM , NEWCM , NODC , CM ( n  ^ ) 

COMMON/TRUMTX/NVTM,TM(n, ) 

o 

COMMON/CONTROL/NVCTL,CTL (n^) 

COMMON/CREGPI /NVRPI , RPI (ttg ) 

COMMON / CCGT /N VCGT , CGT ( n  g ) 

COMMON/CKF/NVFLT , PLT (n^^) 

Note  that  the  arrays  of  /MAINl/  and  /MAIN2/  have  the  same 
allocations  (n^^)  ;  /ZMTXl/  and  /ZMTX2/  also  have  the  same 
allocations  (n^) . 

The  corresponding  statements  setting  the  integer 
variables  to  the  array  allocations  are 
NDIM  = 

NVSM  =  n2 
NVZM  =  ng 
NVDM  =  n^ 

NVCM  =  ng 
NVTM  =  ng 


NVCTL  = 

NVRPI  =  Ho 
NVCGT  =  Hg 
NVFLT  =  n^Q 

The  allocations  needed  for  each  array  are  expressed 
as  functions  of  the  system  dimensions  of  equations  (A-5) , 
(A-10) ,  and  (A-12) .  In  the  equations  to  follow,  'MAX'  is 
a  function  which  takes  the  largest  value  from  among  its 
arguments.  Also,  the  following  names  will  be  used  to  repre¬ 
sent  certain  sums  of  dimensions  (these  names  correspond  to 
mnemonics  employed  within  CGTPIF,  e.g.,  "npld"  mnemonically 
represents  "n  plus  d"  and  "na"  represents  "n  augmented") . 


npld  =  n+d  (A-14a) 
nnpr  =  n+r  (A-14b) 
nwpnwd  =  w+w^^  (A-14c) 
na  =  n+d+n^  (A-14d) 


The  array  allocations  needed  are, 

/MAINl/,  /MAIN2/:  n^^^^MAX  {  [MAX (npld, nnpr)  ]  ^,n^} 

(A-15a) 

/SYSMTX/:  n2J‘MAX{606, 
n (npld+r+p+m+w)  +  p(r+d)  +  m(m+d) 

+d(d+Wjj)  +  w^  +  Wj^ 
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2  2 

[n^(n^+r^+m^+w^+npld)  +  m^  +  w^] , 

[n(3n+2MAX(d,nj^)  )  + 

[nnpr (3nnpr+r)  ] , 

na  } 

(A-15b) 

/ZMTXl/,  /ZMTX2/:  n^  i  MAX[nj^,na^] 

(A-15c) 

/DSNMTX/:  n^  ^  npld(2npld+n+p+m+nwpnwd) 

2  2  2  2 
+  r(n+p)  +  m  +  d  +  w 

(A-15d) 

/CMDMTX/;  ng  >  Hj^Cn^^+r^+Pj^)  +  r^^Cp,^) 

(A-15e) 

2 

/TRUMTX/:  ng  ^  n^(2n^+npld+m+r)  +  m 

(A-15f) 

/CONTROL/;  n.^  >  nnpr ( 2nnpr+p) 

(A-15g) 

2 

/CREGPI/;  ng  ^  r(4r+n)  +  nnpr 

(A-15h) 

/CCGT/;  ng  >  (n+2p)  (n^^+r^^+d) 

(A-15i) 

/CKF/;  nj^Q  ^  npld[  (2npld+m)+l] 

(A-15j) 

Routines  of  CGTPIF  SUBS  which  use  these  arrays 
employ  these  equations  to  verify  sufficient  allocation  has 
been  provided.  If  not,  a  message  is  written  which  spe¬ 
cifies  the  array  in  question  and  the  necessary  allocation; 
execution  then  is  aborted. 

The  MAIN  listed  in  Appendix  D  can  accommodate 
problems  of  dimensions  given  as  follow; 


25 


n  <  15 
npld  5.  15 
r  <  5 

P  i  5 

m  £  15 
w  1  15 
nwpnwd  £  15 


< 

10 

< 

5 

Pm 

< 

5 

"t 

< 

20 

^t 

< 

5 

mt 

< 

15 

"'t 

< 

20 

(A-16) 


In  these  expressions,  the  substitutions  of  equations  {A-14a) 
and  (A-14c)  have  been  used  to  impose  constraints  on  the 
total  number  of  design  model  system  and  disturbance  states. 
These  allocations  are  sufficient  for  problems  all  of  whose 
dimensions  are  equal  to  the  numbers  given  in  equation  (A-16) . 
Moreover,  other  combinations  of  dimensions,  some  greater 
than  and  some  less  than  these  specific  dimensions,  will 
also  be  accommodated.  For  the  set  of  dimensions  appropri¬ 
ate  to  one's  design  problem,  the  equations  of  equation  set 
(A-15)  may  be  used  to  determine  if  existing  allocations  are 
adequate;  or  the  problem  may  be  attempted  and  CGTPIF  will 
signal  any  inadequacies  in  available  allocations  (if  any 
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exist)  .  The  specific  values  of  allocations  through 
”l0^  given  by  the  MAIN  or  Appendix  D  are. 


^1 

= 

400 

"2 

= 

2125 

"3 

= 

1225 

^4 

= 

1750 

"5 

= 

225 

^6 

= 

1725 

^7 

= 

900 

^8 

= 

575 

"9 

= 

400 

"lO" 

690 

(A-17) 


Since  there  are  tvjo  arrays  of  length  n^^  and  also  two 
of  length  n^^  this  represents  a  total  of  (11640)  words 
of  memory  for  array  storage.  As  implemented  in  segmented 
form,  the  memory  utilized  during  execution  is  the  sum  of 
the  memory  required  by  the  largest  of  the  load  segment  sets 
and  the  memory  required  by  the  loader  itself  (about  (10000) g 
words) .  The  arrays  allocated  by  MAIN  are  always  in  memory. 
The  largest  set  of  segments  loaded  at  any  time  includes 
the  segment  vdiich  utilizes  optional  user-provided  routines 
(described  in  the  next  section) .  Thus  the  total  array 
allocations  and  the  memory  required  to  implement  any 
optional  routines  effectively  determine  the  execution  load 
size  attained  by  CGTPIF.  For  the  CYBER  system  and 
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interactive  execution,  the  total  memory  which  is  available 


for  array  storage  and  optional  routines  is  about  (13000) 
words . 

A. 10  Optional  Routines;  Define 

Dynamics  Models 

The  user  may  choose  to  enter  any  of  the  three 
dynamics  models  by  using  subroutines.  Each  model  definition 
requires  at  least  two  specific  subroutines.  These  sub¬ 
routines  may  then  call  any  additional  routines  to  accomplish 
the  necessary  computations — routines  of  CGTPIF  SUBS,  LIBRARY, 
or  any  user-provided  subroutines  may  be  used.  In  the  list¬ 
ing  of  Appendix  D,  DSND,  DSNM,  TRTHD,  TRTHM,  ACDATA,  GUSTS, 
cind  TBLUPl  are  all  optional  routines  used  to  establish 
design  and  truth  models  of  the  longitudinal  dynamics  of  an 
aircraft  subject  to  atmospheric  turbulence. 

For  each  model  defined  by  subroutines,  one  sub¬ 
routine  must  establish  the  dimensions  of  the  model,  and 
another  must  set  the  values  for  all  matrices  of  that  model. 
Each  routine  must  have  the  appropriate  name  and  argument 
list  specified  below.  All  model  arrays  appearing  in  the 
argument  lists  must  be  allocated  in  full  manner:  the  array 
dimensions  specified  by  "Dimension"  statements  within  the 
routines  must  be  exactly  those  implied  by  the  routine 
specifying  model  dimensionalities  and  the  array  sizing  given 
by  equations  (A-6),  (A-10)  ,  and  (A-13)  .  For  excimple,  if 
the  number  of  design  model  states  (n)  is  established  as  10, 
then  according  to  equation  (A-6)  the  system  matrix  must  be 
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explicitly  uimensioned  A(10,10)  in  the  subroutine  vdiich 
sets  array  values  for  the  de&  gn  model.  All  of  these  arrays 
^u:e  initialized  to  zero  before  the  array  setting  routines 
eu:e  called,  so  it  is  necessary  only  to  set  non- zero  array 
elements  within  the  subroutines.  Any  arrays  of  dimension 
one  in  both  row  euid  column  are  actually  scalars  and  need 
not  be  included  in  a  Dimension  statement.  Any  arrays  with 
row  or  column  dimension  of  zero  are  in  fact  nonexistent 
arrays  and  must  not  be  included  in  Dimension  statements, 
although  they  still  must  be  included  in  the  subroutine's 
eirgument  list  (since  calls  to  these  routines  from  within 
CGTPIF  assume  full  argument  lists) . 

A. 10.1  Design  Model.  The  two  routines  required 
for  the  design  model  are  'DSND'  and  'DSNM' .  The  first 
specifies  dimensions  of  the  model  while  the  second  sets  the 
array  elements  for  that  model. 

DSND  has  a  single  argument: 

SUBROUTINE  DSND(ND) 

with  ND  an  int*»ger  vector  of  length  seven.  In  DSND  the 
elements  of  ND  are  set  to  the  dimensions  given  by  equation 
(A-5)  and  in  the  order  shown.  Thus,  for  example,  element  1 
is  set  to  the  value  n,  element  2  is  set  to  the  value  r,  and 
so  on . 

DSNM  has  14  arguments: 

SUBROUTINE  DSNM(A,B,EX,G,Q,C,DY,Ey ,H,HN,R,AN, 
GN,QN) 

Each  argument  is  an  array  defined  in  equation  (A-2) ,  (A-3) , 
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or  (A-4) .  Note  the  order  in  which  the  arrays  appear  in  the 
argument  list  is  the  same  as  the  order  of  the  arrays  listed 
in  equation  (A-6)  and  the  dimensions  given  in  that  equation 
must  be  specified  in  DSNM.  Thus,  for  example,  if  DSND 
sets  n=5  then  the  matrix  A  must  be  dimensioned  A(5,5)  in 
DSNM. 


A. 10. 2  Truth  Model .  The  two  routines  required 
for  the  truth  model  are  'TRTHD'  and  'TRTHM* .  The  first 
specifies  dimensions  of  the  model  vdiile  the  second  sets  the 
array  elements  for  that  model 

TRTHD  has  a  single  argument; 

SUBROUTINE  TRTHD (ND) 

with  ND  an  integer  vector  of  length  four.  In  TRTHD  the 
elements  of  ND  are  set  to  the  dimensions  given  by  equation 
(A- 9)  and  in  the  order  shown. 

TRTHM  has  8  arguments; 

SUBROUT INE  TRTHM ( AT , BT , GT , QT , HT , RT , TDT , TNT ) 

Each  argument  is  ein  array  defined  in  equation  (A-7)  or 
(A-8) .  Note  the  order  in  vdiich  the  arrays  appear  in  the 
argument  list  is  the  same  as  the  order  of  the  arrays 
listed  in  equation  (A-10)  and  the  dimensions  given  in  that 
equation  must  be  specified  in  TRTHM. 

A. 10. 3  Command  Model .  The  two  routines  required 
for  the  command  model  are  'CMDD'  and  'CMDM' .  The  first 
specifies  dimensions  of  the  model  vdiile  the  second  sets  the 
array  elements  for  that  model. 
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CMOD  has  a  single  argument: 
SUBROUTINE  CMDD(ND) 


with  ND  an  integer  vector  of  length  three.  In  CMDD  the 
elements  of  ND  are  set  to  the  dimensions  given  by  equation 
(A-12)  cuid  in  the  order  shown. 

CMDM  has  4  arguments: 

SUBROUTINE  CMDM ( AM, BM, CM, DM) 

Each  argument  is  an  array  defined  in  equation  (A-11) .  Note 
the  order  in  which  the  arrays  appear  in  the  argument  list 
is  the  same  as  the  order  of  the  arrays  listed  in  equation 
(A-13)  and  the  dimensions  given  in  that  equation  must  be 
specified  in  CMDM. 

A. 11  CGTPIF  SUBS 

In  contrast  to  the  routines  described  in  Sections 
A. 9  and  A. 10,  the  routines  of  CGTPIF  SUBS  require  no  modifi¬ 
cation  to  apply  to  specific  design  problems.  In  discussing 
CGTPIF  SUBS  some  detail  as  to  the  operation  of  specific 
routines  is  given.  For  users  vdio  may  elect  to  attempt 
modification  of  routines,  a  detailed  examination  of  the 
source  code  is  essential. 

The  executive  routine  for  CGTPIF  SUBS-CGTXQ-  is 
discussed  first.  Each  major  computational  element  and  con¬ 
stituent  routines  are  then  discussed  in  turn. 

A.  11.1  CGTXQ .  The  overall  execution  logic  of 
CGTPIF  is  determined  by  routine  'CGTXQ'.  Specific 
execution  of  the  designs  is  achieved  by  calls  to  other 
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individual  routines,  which  are  in  turn  executives  to 
routines  comprising  the  various  computational  elements 
shown  in  Figure  A-1. 

Figure  A-4  gives  a  flowchart  of  CGTXQ  vdiich  empha¬ 
sizes  the  major  program  decisions.  Blocks  representing 
calls  to  the  particular  computational  elements  give  (1) 
the  name  of  the  routine  which  is  executive  to  that  element, 
and  (2)  the  letter  code  used  in  Figure  A-1  to  represent 
that  element. 

All  "flag"  variables  used  by  CGTXQ  and  CGTPIF  SUBS 
are  integers.  A  value  of  zero  implies  that  the  condition 
flagged  is  not  true.  While  a  non-zero  value  generally 
inplies  the  condition  is  true,  positive  and  negative  values 
sometimes  distinguish  between  different  attributes  of  that 
condition.  Flags  v^ich  pertain  to  general  program  logic 
are  included  in  the  /DESIGN/  Common;  flags  which  relate 
strictly  to  specific  computational  elements  are  passed  as 
arguments  in  calls  to  the  respective  executive  routines. 

The  elements  of  Common  /DESIGN/  are  defined  as 

"NVCOM":  The  smaller  of  the  array  allocations  of 

/MAINl/  and  /ZMTXl/.  Throughout  much  of 
CGTPIF  SUBS,  the  same  array  sizes  are  needed 
for  COMl,  COM2,  ZMl ,  and  ZM2.  NVCOM  is 
tested  to  determine  if  sufficient  allocation 
is  available  for  the  temporary  arrays. 

"TSAMP":  The  controller  sample  period  (in  seconds) . 
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LFLRPI":  Flag  variable  indicating  availability  of  PI 
gains  in  program  storage.  A  value  of  0 
means  the  gains  are  not  available.  Values 
of  -1  and  +1  mean  the  gains  cire  available  and 
have  been  obtained  either  from  the  DATA  file 
or  by  computation  in  the  current  program 
execution,  respectively. 

LFLCGT";  Flag  variable  indicating  if  CGT  design/ 

evaluation  is  in  execution.  A  value  of  1 
means  a  CGT  design  has  been  determined,  while 
values  of  0  and  -1  mean  the  converse.  More¬ 
over,  a  value  of  -1  signifies  that  an  open- 
loop  CGT  design  is  infeasible  (PI  gains  not 
available  and  design  system  unstable) . 

LFLKF":  Flag  variable  indicating  filter  design  is  in 

execution. 

LTEVAL" :  Flag  variable  indicating  controller  evaluation 
is  with  respect  to  truth  model . 

"LABORT":  Flag  variable  indicating  execution  abort 

status.  If  LABORT  is  positive  then  execu¬ 
tion  will  abort  due  to  insufficient  array 
allocation,  and  the  specific  value  is  the 
allocation  needed.  If  LABORT  is  negative, 
the  abort  is  due  to  dimensional  incompatibil¬ 
ity  as  mentioned  in  Section  A. 7  for  each 
model.  If  the  incompatibility  affects  the 
design  model  the  program  aborts  execution; 
for  the  other  models  only  the  specific  exe¬ 
cution  path  is  aborted. 


"IPI",  "ICGT",  "ITRU",  and  "IFLTR"  are  additional 
flags  related  to  specific  computations.  IPI  and  IFLTR 
test  the  successful  execution  of  the  computations  of 
routines  'PIMTX'  and  'FLTRK',  respectively.  The  other  two 
flags  have  values  according  to: 

"ICGT";  Flag  tests  if  command  model  is  established. 

A  non- zero  value  indicates  the  command  model 
is  established,  and  if  negative  that  it  has 
also  been  written  to  the  SAVE  file.  If  the 
command  model  is  not  established,  ICGT  is 
zero . 

"ITRU":  Flag  tests  if  truth  model  is  established. 

Specific  values  have  the  same  significance 
as  for  ICGT,  but  with  respect  to  the  truth 
model . 

CGTXQ  includes  other  decision  tests  not  shown  in 
Figure  A-4 .  These  are  not  discussed  since  they  involve 
obvious  tests  on  the  flags  defined  above  and  the  code  is 
simple . 

A. 11. 2  SETUP .  Routine  ’SETUP'  serves  as  an  inter¬ 
mediary  in  establishing  the  various  dynamic  models  used  by 
CGTPIF.  It  calls  one  of  three  other  routines  according  to 
the  value  of  its  input  argument  "ITYPE".  The  design,  com¬ 
mand,  or  truth  models  are  established  for  ITYPE  =  1,  2,  or  3, 
respectively . 

The  routines  'SDSN',  'SCMD',  and  'STRTH'  actually 
establish  each  of  the  models.  Each  uses  the  routine  'RSYS' 
to  enter  the  continuous-time  model  representation.  The 


model ' s  arrays  are  stored  initially  in  vector  SM  of 
/SYSMTX/  Common.  Each  model  is  discretized  (using  the 
sample  period  T  =  TSAMP)  and  the  new  arrays  defining  the 
discrete-time  models  are  stored  in  permanent  vectors  DM, 

CM,  or  TM  of  the  /DSNMTX/,  /CMDMTX/ ,  or  /TRUMTX/  Commons, 
respectively . 

The  continuous-time  models  are  entered  with  sub¬ 
routine  RSYS.  The  models  may  be  entered  directly  from  the 
user  terminal,  from  the  DATA  file,  or  using  optional  user- 
provided  routines  described  in  Section  A. 10. 

The  computations  performed  under  SDSN,  SCMD,  and 
STRTH  are  discussed  below.  The  routines  which  perform  each 
computation  are  indicated  following  the  equations. 

A. 11. 2.1  SDSN.  SDSN  calls  RSYS  to  read  in  the 
dimensions  of  the  design  model  and  the  arrays  defining  it. 
The  dimensions  are  stored  in  the  variables  of  /NDIMD/ . 

The  first  seven  variables  are  the  dimensions  of  equation 
(A-5)  in  order  and  the  final  three  are  the  sums  of  dimen¬ 
sions  of  equations  (A-14a) ,  (A-14c) ,  and  {A-14b) ,  respec¬ 
tively.  A  call  to  'DSCRTD'  then  gives  the  discretized 
model . 

An  augmented  system  description  is  formed  with 


the  system  and  disturbance  states; 


M 


and  partitioned  matrices  describing  the  dynamics  of  the 
augmented  system  are  formed: 
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with  component  matrices  defined  in  equations  (A-2)  and 
(A-3) .  Matrices  A  and  G  are  stored  permanently  in  vector 
"DM"  for  reuse  in  Kalman  filter  design. 

The  corresponding  discrete-time  augmented  state 
transition  model  is, 

=  ia£a'‘i'  *  5a  “(‘i'  *  £aa'‘i> 


(A-20) 


where,  assuming  u  is  constant  over  a  sample  period. 
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where  i  (T-T)=e  ^  and  the  strength  of  w  is  given  by 
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Matrix  $  is  stored  permanently  in  vector  "FLT"  of  /CKF/ 

cL 


and  Q  is  stored  permanently  in  vector  DM. 


—a 


$  and  B  may  be  partitioned  to  the  component 
-a  a^ 

dimensions  to  yield 
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Matrices  and  B^  are  stored  permanently  in 

d 

vector  DM.  The  deterministic  discrete-time  design  model 


then  is. 


x(ti^l)  =  ^(t^)  +  B^u(t^)  +  Hd^^i^  (A-23a) 

d 


Sd<Vl>  =  in2a'‘i* 


(A-23b) 


y(t^)  =  ^(t^)  +  DyU(t^)+Eyn^(t^)  (A-23cil 
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Matrices  C,  D^,  and  are  as  originally  defined  and  are 
retained  in  vector  DM.  Equations  (A-23a-c)  are  used  to 
propagate  the  time  response  for  the  design  model  in  the 
controller  evaluation  routines. 

An  augmented  measurement  matrix  is  formed  and 
stored  in  vector  DM; 

H  =  IH  1  H„]  (A-24) 

Ci  ”  “11 

where  H  and  are  as  in  equation  (A-2d) . 

The  noise  strengths  Q,  Q^,  and  R  of  equations  (A-3) 
and  (A-4)  are  also  stored  in  vector  DM  so  that  they  afe 
available  for  modification  in  the  Kalman  filter  design 
path. 

To  avoid  unnecessary  computations  in  later  code, 
if  matrix  E^  does  not  exist  or  if  D^  or  E^^  are  zero 
matrices  then  the  variables  "NODY"  or  "NOEY"  (/DSNMTX/) 
are  set  to  1  as  appropriate.  In  other  circumstances  these 
variables  are  zero  and  computations  involving  these  arrays 
are  carried  out. 

Equations  (A-18) ,  (A-19) ,  (A-21) ,  (A-22) ,  and 

(A-24)  are  computed  under  the  direction  of  DSCRTD.  Routine 

'QDSCRT'  (called  by  DSCRTD)  forms  the  partitioned  matrix 

Q  and  computes  the  matrix  Q  using  the  LIBRARY  routine 
a  a^ 

'INTEG'.  DSCRTD  computes  <I>  and  B  using  a  call  to  the 

”^3  3  j 

Q 

LIBRARY  routine  'DSCRT'. 
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A. 11. 2. 2  SCMD.  SCMD  begins  by  testing  if  PI 
regulator  gains  are  available.  If  they  are,  a  CGT/PI 


design  will  be  pursued  by  routine  'SCGT'.  If  not  already 
available,  the  user  may  choose  that  the  PI  gains  be  read 
from  the  DATA  file.  If  the  gains  are  not  available  and 
the  system  is  stable  then  an  open-loop  CGT  design  will  be 
pursued  by  SCGT;  otherwise,  if  not  stable,  no  CGT  design 
is  allowed  and  SCMD  is  exited.  The  logic  is  represented 
in  the  flowchart  of  Figure  A-5.  The  remainder  of  SCMD 
is  indicated  by  the  block  "establish  command  model"  and 
is  described  below. 

The  command  model  may  be  established  repeatedly 
during  program  execution.  It  is  entered  with  a  call  to 
routine  RSYS.  The  dimensions  of  the  model  are  stored  in 
the  variables  of  /NDIMC/  and  in  the  order  shown  in  equa¬ 
tion  (A-12) .  A  call  to  'DSCRTC  then  gives  the  discretized 
model : 


— m  1+1  — m— m  i  — m^— m  i 


(A-25a) 
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where,  for  ^  constant  over  a  sample  period 
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and  A_,  B  ,  C  ,  and  are  as  defined  in  equation  (A-11) . 

—HI  —HI  —HI  —HI  ’ 

Matrices  ♦  and  are  computed  with  a  call  to 
-m  -m^ 

routine  DSCRT  of  the  LIBRARY.  4>  ,  B  ,  C  ,  and  D  are 

-m  ~ni  -m 

stored  in  vector  "CM"  of  /CMDMTX/ .  Equations  (A-25a,b) 


are  used  in  propagating  the  model  states  and  outputs  in 
the  controller  evaluation  routines. 


In  /CMDMTX/,  the  variable  "NEWCM"  signals  that  a 


new  command  model  is  being  established  (NEWCM  non-zero) . 


If  the  matrix  D  is  zero,  the  variable  "NODC"  is  set  to  a 
— m 

non-zero  value. 


A.  11. 2. 3  STRTH .  The  continuous-time  truth  model 
is  established  with  a  call  to  routine  RSYS.  During  program 
execution  the  truth  model  can  be  redefined  as  often  as 
desired.  The  dimensions  of  the  model  are  stored  in  the 
variables  of  /NDIMT/  in  the  order  shown  in  equation  (A-9) . 

A  call  to  'DSCRTT'  discretizes  the  truth  model: 


~  ~  d  "  d 


where,  for  u^  constant  over  a  sample  period. 
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and  the  strength  of  the  noise  w.  is. 


(A-28b) 
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9.*.  =  f  ^<T-T)G.Q.GV(T-T)dT  (A-28c) 


42 


Matrices  as  well  as  H^,  R^,  Tj^^,  and  are 

stored  in  vector  "TM"  of  /TRUMTX/ . 

DSCRTT  computes  £  and  B  using  routine  DSCRT  of 

LIBRARY.  Q.  is  computed  using  routine  INTEG. 

^d 

A.  11. 3  PIMTX.  Computations  that  are  necessary 
to  the  controller  designs  but  independent  of  design  itera¬ 
tion  for  a  fixed  design  model  are  computed  under  the 
direction  of  PIMTX.  The  input  argument  IPI  is  set  to  1 
following  successful  computation;  subsequent  entries  into 
PIMTX  then  test  IPI  and  return  immediately  without  recompu¬ 
tation  of  the  information. 

PIMTX  forms  an  augmented  matrix  and  then  forms  its 
inverse.  The  resulting  matrix  is  termed  the  £  matrix. 
Partitions  of  the  n  matrix  into  sub-arrays  of  the  original 
component  dimensions  are  then  stored  individually  in  the 
vector  "CTL"  of  /CONTROL/. 
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PI  and  CGT  controllers. 
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PIMTX  then  calls  routine  'CDIF',  which  sets  up  two 
augmented  matrices  for  the  control-difference  PI  regulator: 


4  = 

-6 


♦  I  ^ 


0  '  I 


(A-30a) 


= 


(A-30b) 


and  Bg  are  stored  in  vector  CTL  of  /CONTROL/ . 


A. 11. 4  SREGPI .  Computations  involved  in  the 
design  of  the  PI  regulator  are  directed  by  routine  SREGPI. 
Routine  'WXUS'  is  called  first  to  determine  the  quadratic 
weighting  matrices  of  the  discrete-time  optimal  cost  func¬ 
tion  from  the  continuous-time  input  quadratic  weights. 
Quadratic  weighting  matrices  (assumed  diagonal)  are 
entered  directly  by  the  user  from  the  terminal  for  costs 
assigned  to  output  and  input  deviations  and  to  input  rates — 
Y,  U  ,  and  U  respectively.  These  matrices  are  stored  in 

y 

vector  "RPI"  of  /CREGPI/.  An  augmented  perturbation  state 
vector  is  defined  to  be 


X 


6x 

6u 


(A-31) 


A  weighting  matrix  on  the  state  vector  x  is  formed  as 
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X 


T 

=  C^YC 


(A-32a) 


'-11 

=  "y  ^  (A-32b) 

X  =  C^YD  (A- 32c) 

-^12  y 


Routine  'FORMX'  performs  these  computations  and  forms 


(A-33) 


The  user  is  then  given  an  opportunity  to  modify  individual 
elements  of  X  (symmetry  is  preserved  automatically  by 
WXUS) ,  as  for  instance,  to  alter  individual  diagonal  ele¬ 
ments  of  X  .  The  associated  continuous-time  cost  func- 

-Cii 

tion  is, 


(A-34) 


where  u  is  the  control  difference  ("pseudo-rate") 

u  =  Au  (A-35) 

The  corresponding  discrete-time  cost  function  is  defined 
by 
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and  the  discrete  costs  are. 
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B,(T)  =  /  $(o)Bda  (A-37e) 

a  Jq 

and  Bg  is  as  defined  in  equation  (A-30b) .  The  integrals 
of  equations  (A-37a,b,c)  are  approximated  in  a  two-step 
computation.  First,  and  B^  are  treated  as  constants 
over  the  sample  interval  with  value  set  to  their  respec¬ 
tive  averaged  values  at  the  beginning  and  end  of  the 


interval : 


^6  =  +  IdJ 


(A-38a) 


and  §5  =  ^tO  +  Bg]  (A-38b) 

in  which  and  are  as  defined  in  equations  (A-30a,b) . 
With  these  approximations,  each  of  the  integrands  is  con¬ 
stant  over  the  integration  time  T,  so  the  integrals  are 
obtained  as 

=  T['i^x'$,]  (A-39a) 

£5  =  (A-39b) 

S  =  (A-39c) 

This  is  a  better  approximate  evaluation  than  simple  Euler 
inegration  provides.  These  three  discrete-time  costs  are 
returned  by  WXUS  as  arguments  "X","U",  and  "S",  respec¬ 
tively. 

The  cost  function  of  equation  (A-36)  includes  the 
cross-weight  weighting  products  of  states  and  inputs. 
Routine  'PXUP'  is  called  to  compute  modified  system  and 
weighting  matrices  to  allow  the  optimization  to  be  framed 
in  terms  of  state  and  input  quadratic  costs  only  (Ref  29) : 
Define  a  modified  system, 

-^^i+1^  ^  (A-40a) 
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with 


iS  =  is  -  SsU-^S^  (A-40b) 

u'  =  u  +  (A-40C) 

for  which  the  cost  function  becomes 

N 

J'=  y~^i5[x'^(t^)X^x(t^)+u"'^(t^)U^u"(t^)  ]  (A-41a) 

i=0 

and 

=  2^5  ~  (A-41b) 


The  cost  function  of  equation  (A-41a)  is  now  in  standard 

form  for  solution  of  the  steady-state  Riccati  equation. 

“1  T 

PXUP  returns  matrices  X^,  and  of  equations 

(A-40b) ,  (A-41b) ,  and  (A-40b) ,  respectively.  An  additional 
matrix  needed  for  the  routine  which  computes  the  solution 
to  the  Riccati  equation  is  also  computed  by  PXUP: 

0^  =  (A-42) 

SREGPI  next  computes  the  steady-state  solution  to 
the  discrete-time  Riccati  equation  using  routine  'DRIC  of 
LIBRARY.  DRIC  solves  for  in 

Sr  =  ifSRd+oJSRr^ij  +  xj'  (A-43) 
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using  an  iterative  procedure  discussed  in  Reference  24 . 

In  addition  to  Kj^-,  DRIC  returns  the  closed-loop  system 
matrix 

ijCL  =  IA-44) 

which  is  stored  in  vector  RPI. 

Routine  'GCSTAR'  then  is  called  to  compute  the 
optimal  feedback  gain  matrix  for  the  original  system  in 
two  steps: 

The  optimal  feedback  gains  for  the  modified  system  of 
equation  (A-40)  are, 

(A-45) 

and  from  these  the  optimal  feedback  gains  for  the  original 
system  are  obtained; 

G*  =  G*'  +  U~^sJ  (A-46) 

which  can  be  considered  as  partitioned  into  gains  on  the 
components  of  the  state  vector  x  of  equation  (A-31) .  The 
optimal  input  then  is , 

6x (t . ) 

Au*(t.)  =  -  [^  I  G*  1 - (A-47) 

-  X  -c^i  -c^ 

SREGPI  uses  these  partitions  of  ^  and  partitions 

of  the  n  matrix  of  equation  (A-29)  to  compute  the  gains 

K  and  K  of  the  optimal  PI  regulator  and  stores  them  in 
X  ”  z 

vector  RPI; 


K  =  G*  n, ,  +  G* 

— X  — Cj^— 11  -C2~21 


=  ^^ll2  ^  ^2-22 


(A-48a) 


(A-48b) 


The  PI  regulator  in  incremental-form  (Ref  32)  utilizing 
these  gains  is  implemented  as. 


u(t^)  =  u(t^_j^)  -  Kj^[x(t^) -x(t^_^)  ) 


K 

— z 


X  (t .  ,  ) 

[c  D  ] 

—  i-1 

— y 

(A-49) 


The  controller  evaluation  routines  which  propagate  the 
response  of  the  PI  regulated  system  to  non- zero  initial 
conditions  use  equation  (A-49)  to  compute  the  control 
input.  Note  that  this  assumes  that  the  outputs  are  to  be 
driven  to  zero  by  the  PI  regulator.  No  provision  is  made 
for  evaluation  of  the  PI  regulator  in  response  to  control 
inputs. 

A. 11. 5  SCGT.  Routine  SCGT  directs  the  computa¬ 
tions  involved  in  design  of  an  open-loop  CGT  or  closed- 
loop  CGT/PI  controller.  The  first  set  of  computations 
are  performed  by  routine  'CGTA';  the  results  depend  only 
on  the  design  and  command  models.  Since  the  design  model 
is  invariant  throughout  program  execution,  CGTA  is  not 
called  unless  a  new  command  model  has  been  established 
(test  value  of  variadjle  NEWCM  in  /CMDMTX/)  . 
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The  CGT  theory  formulates  an  "ideal"  state  and 
input  trajectory  to  achieve  exact  matching  with  the  commemd 
model  outputs.  These  ideal  trajectories  are  assumed  to  be 
expressable  as  linear  functions  of  the  command  model's 
states  and  inputs  and  the  disturbance  states: 


Xi(t.) 

A  1  A  1  A 

-11!  -12!  -13 

*21'  -22'  -23 

Sd'V 


(A-50) 


A  set  of  equations  are  derived  for  the  A^^^ 
partitions.  They  are. 


^11  =  IlAl'Vi'  ^  ;i2£,n 


A,  „  =  TT  A,  ,B  +  ir.  _D 
—1 2  —1 1—1 1— m^  —1 2— m 


-13  ■  -11-13  ■  -lA 


^21  =  IlAl'Vi'  *  ^225™ 


^22  =  l2Al5~  +  l222in 

a 


^23  -21-13 ^-n"-^  ■  -21-x 


through  A22 

(A-51a) 

(A-51b) 

(A-51c) 

(A-51d) 

(A-51e) 

l22^ 


Of  these  equations,  those  for  A^^^^  (equation  A-51a)  and 
—13  A-51c)  must  be  solved  independently.  The 
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other  equations  then  express  the  remaining  matrices  in 
terms  of  known  matrices.  The  two  equations  to  be  solved 
are  of  the  form 


X  =  AXB  +  C 


(A-52) 


for  which  an  algorithm  for  solution  is  reported  in  Refer¬ 
ence  4.  This  algorithm  has  been  implemented  in  routines 
described  in  Reference  10.  Certain  conditions  vdiich  must 
be  met  for  a  solution  to  exist  are  discussed  in  these 
references  and  in  Reference  32,  as  well  as  in  Section 
3.3.3  of  this  thesis. 

CGTA  sets  up  equations  (A-51a)  and  (A-51c)  then 
calls  routine  'AXBMXC  to  solve  for  A^^j^  and  AXBMXC 

solves  each  equation  using  routine  'SLVSHR'.  Iterative 
refinement  of  the  solution  is  pursued  until  the  Euclidean 
norm  of  the  error  residual  matrix  is  less  than  10  ^ 
(routine  'ENORM')  or  as  many  as  three  refining  iterations. 
If  the  solution  does  not  meet  the  error  tolerance  after. 


three  refinement  steps,  a  message  is  printed  and  execution 
proceeds.  The  routines  AXBMXC,  SLVSHR,  and  ENORM  are 
adaptations  of  routines  described  in  Reference  10. 


With  Aj^^  and  A^^^  determined,  CGTA  proceeds  to 


compute  A^2'  —21'  —22'  —23* 

stored  in  vector  "CGT"  of  /CCGT/ . 


All  the  A.  .  itiatrices  are 
-ID 


SCGT  then  calls  routine  'CGTKX'  to  compute  the 
gains  employed  by  the  CGT  and  CGT/PI  controllers.  For  the 
open-loop  CGT  controller  routine  SCMD  sets  matrices 
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and  K  of  equation  (A-48)  to  zero.  CGTKX  computes  gains 
^”2 

on  commemd  model  states  2uid  inputs  euid  disturbance  states, 
respectively,  as 

5*  -  +  *21  (A-53a) 

m 


%  *  £^2  £22 

£x  '  £x£i3  ^  £23 
n 


These  three  gains  are  stored  in  vector  CGT. 

The  closed-loop  CGT/PI  control  law  is  implemented 
in  incremental  form  as 


u(t^)  =  "-^^i-l^  ^ 


+  K V  (t.  ,)] 

— x_  — m  1  ~m  i-J. 
m 

+  K  [u  (t.) -u  (t .  , ) ] 
—X  — m  1  ~m  1— J. 
u 


'Sd'V-Sd'Vi'i 

n 


+  K 
— z 


— m  ~m 


X  (t.  ,) 
— m  i-i 

—in  1 


-  [C  D) 


£<Vi' 

S"=i-3> 


(A- 54) 


The  open-loop  CGT  is  obtained  by  employing  equation  (A-54) 
with  PI  gains  K  and  K  both  zero  matrices,  giving  the 

X  ^”2 

effective  result  for  the  open-loop  CGT  control  law  as 
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(A-55) 


Equation  (A-54)  is  used  by  the  controller  evaluation 
routines  to  compute  control  inputs  for  either  CGT  con¬ 
troller. 


A.  11. 6  CEVAL.  Routine  'CEVAL'  is  executive  to  a 
set  of  routines  vdiich  perform  evaluations  of  the  PI,  CGT, 
or  CGT/PI  controllers.  If  the  PI  regulator  is  being  evalu¬ 
ated,  the  continuous-time  domain  mapped  eigenvalues  of  the 
closed-loop  matrix  equation  (A-44)  are  computed 

and  printed  by  the  routine  'POLES'.  The  primary  evaluation 
tool  is  the  simulated  time-response  of  the  controlled 
system.  For  the  PI  regulator  the  response  is  generated 
for  non-zero  initial  conditions  and  no  commanded  input. 

The  system  with  either  CGT  controller  is  driven  by  step 
inputs  on  any  one  of  the  command  model's  inputs  and  by 
non-zero  initial  conditions  on  system  and  disturbance 
states,  if  desired.  The  system  time  response  can  be  propa¬ 
gated  using  either  the  design  model  or  the  truth  model 
state  transition  equations.  Plots  of  the  resulting  time 
behavior  of  the  states,  inputs,  and  outputs  of  the  system 
are  printed  at  the  user  terminal  and  output  to  the  LIST 
file . 
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Specific  execution  of  the  controller  evaluation  is 
affected  by  flags  "LFLCGT"  and  "LTEVAL"  of  /DESIGN/. 

These  signal  the  design  as  either  of  PI  (LFLCGT=0)  or  CGT 
type,  and  indicate  the  evaluation  is  to  be  with  respect 
to  the  design  (LTEVAL=0)  or  truth  models.  The  flowcharts 
of  Figures  A-6a,b,c  show  the  basic  decisions  and  execution 
paths  pursued  in  the  controller  evaluation.  As  many  as 
two  plots  of  user-selected  variables  may  be  printed  at  the 
user  terminal  while  plots  of  all  relevant  variables  are 
also  output  to  the  LIST  file.  If  the  user  wishes  no  plots 
printed  at  the  terminal,  the  time-response  simulation  is 
not  executed.  Each  plot  can  include  as  many  as  five  vari¬ 
ables  plotted  versus  time. 

Because  the  routines  execute  differently  according 
to  the  specific  conditions  of  the  controller  to  be  evalu¬ 
ated  emd  the  system  model  used  for  simulation,  there  are 
numerous  tests  and  variant  sections  of  code.  Details 
finer  than  that  shown  in  Figures  A-6a,b,c  are  not  discussed 
Response  varicJales  are  stored  at  each  time  step 
in  sets  by  type  in  the  scratch  vector  SM  of  /SYSMTX/ . 

A  collection  of  several  sets  of  variables  is  itself  con¬ 
sidered  to  be  the  set  of  all  relevant  variables  for  plot¬ 
ting  at  each  sample  time.  Other  sets  of  variables  at  one 
sample-time  in  the  past  are  also  stored  in  vector  SM.  The 
partitioning  of  SM  occurs  both  in  routine  CEVAL  and  'VOUTIC 
Routine  VOUTIC  is  used  to  establish  initial  condi¬ 
tions  for  the  system  and  to  define  the  desired  plots.  The 
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states  of  the  model  to  be  used  for  system  time  propagation 
are  given  initial  values  by  the  user.  For  the  PI  evalua¬ 
tion,  the  following  variables  may  be  plotted:  system 
states,  outputs,  and  inputs.  For  the  CGT  evaluation  the 
disturbance  states  and  the  outputs  of  the  command  model 
may  also  be  plotted.  If  a  command  model  output  is  among 
the  variables  in  a  terminal  plot,  then  all  variables  of 
the  plot  are  plotted  using  a  single  scale  range  to  facili¬ 
tate  evaluation  of  actual  and  commanded  output  responses. 

For  all  other  plots  each  variable  is  scaled  independently. 
Ordinarily  the  input  argument  "NVOUT"  specifies  the  total 
number  of  relevant  system  variables  available  for  plotting. 
VOUTIC  sets  NVOUT  to  zero  if  no  plots  are  to  be  printed  at 
the  user  terminal;  CEVAL  then  does  not  perform  a  simula¬ 
tion  . 

Routine  'CTRESP'  performs  the  time-response  simula¬ 
tion.  An  input  argument  gives  the  total  intended  duration 
of  the  simulation  ("TEND").  CTRESP  executes  the  simula¬ 
tion  as  an  integer  loop  with  control  inputs  and  model  propa¬ 
gation  computed  during  each  pass.  The  value  of  TEND  is 
adjusted  so  that  the  total  time  is  an  integer  multiple  of 
the  controller  sample  period  and  of  one  hundred.  Thus  all 
plot  samples  coincide  precisely  with  controller  samples 
and  the  entire  time  interval  is  spanned  by  100  evenly 
spaced  samples.  The  loop  is  executed  for  the  nunber  of 
steps  thus  determined.  A  vector  of  response  veiriables  is 
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written  to  the  PLOT  file  at  one  hundred  equally  spaced 
time  samples  during  the  simulation. 

In  performing  the  simulation,  eight  primary  routines 
cure  used.  They  are  discussed  briefly  below: 


'DUPDAT':  Propagates  the  states  of  the  design  model 
forward  in  time  using  equations  (A-23a,b) . 

'CUPDAT*:  Propagates  the  states  of  the  command  model 

forward  in  time  using  equation  (A-25a) . 


'TUPDAT':  Propagates  the  states  of  the  truth  model 

forward  in  time  using  equation  (A~27)  with¬ 
out  the  noise  input. 


'XFDT':  Transforms  the  state  vector  of  the  truth 

model  to  the  design  model  state  and  distur¬ 
bance  vectors  using  equations  (A-7c,d) . 


'URPI';  Computes  the  control  input  due  to  the  PI 
controller  alone  using  equation  (A-49) . 


'UCGT' ; 


Computes  the  control  input  due  to  the  CGT 
controller  alone  and  adds  it  to  the  control 
given  by  URPI.  The  increment  due  to  the  CGT 
or  CGT/PI  alone  is  added  as 


u(t.)  .u(t  )  + 

m 


n 


X  (t.  ,) 

— m  i-i 


+  K,[C„  D  ] 
— z  — m  ~m 


u  (t.) 
— m  1 


(A-56) 
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'YDSN' : 


Computes  the  outputs  of  the  design  model 
using  equation  (A-23c) • 


'YCMD';  Computes  the  outputs  of  the  command  model 
using  equation  (A-25b) . 

On  return  to  CEVAL  the  PLOT  file  contains  101  sets 
of  scunples  from  the  system  time  response  simulation 
(sample  at  time=0.  and  one  hundred  additional  samples  at 
equal  time  intervals) •  Plots  of  selected  variables  to  the 
user  terminal  include  51  sample  points  for  each  variable. 

If  the  time  duration  originally  requested  for  the  Simula- 
tion  spanned  fewer  than  50  controller  sample  periods,  the 
terminal  plots  will  have  a  duration  equal  to  50  times  the 
controller  sample  period.  Otherwise,  alternate  samples 
from  among  those  on  the  PLOT  file  are  plotted:  the  entire 
duration  of  the  simulation  is  spanned  but  with  time  resolu¬ 
tion  half  as  fine  as  available  from  the  PLOT  file  samples. 
Plots  are  then  output  to  the  LIST  file.  These  plots  include 
all  sample  points  and  all  variables  are  plotted.  Each  plot 
includes  the  time-responses  of  five  variables.  Routine 
'PLOTLP'  computes  and  prints  all  plots  to  the  terminal  and 
the  LIST  file. 

When  plotting  is  complete,  CEVAL  provides  the  oppor¬ 
tunity  to  perform  additional  simulations  with  the  same 
controller.  When  no  additional  simulations  are  to  be  run, 
CEVAL  is  exited. 
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A. 11. 7  FLTRK.  Routine  'FLTRK*  effects  design  of 
a  steady-state  Kalman  filter  for  the  design  model  defined 
by  equations  (A-20)  and  (A-21) .  The  measurement  equation 
given  by  equations  ,(A-2d)  and  (A-4)  is  rewritten  in  terms 
of  the  augmented  state  vector  and  augmented  measurement 
matrix  (equations  (A-18)  aind  (A-24)): 


z(t.)  =  H  X  (t.)  +  v(t.) 


(A-57) 


A  call  to  routine  'KFLTR'  of  LIBRARY  computes  the  steady- 
state  covariance  matrix  and  the  Kalman  filter  gains.  The 
covariance  matrix  is  the  solution  P  satisfying 

““Si 


-a— a--a 


—a 


(A-58) 


and  the  Kalman  filter  gain  matrix  is, 


K„  =  P  h'^[H  P  h'^+R]”^ 
— F  —a— a  —a— a— a  — 


(A-59) 


The  P^  matrix  employed  is  prior  to  update (P  ) . 

'“~Si  "“S 

KFLTR  uses  an  iterative  technique  described  in  Reference 
24  to  compute  the  matrix  P^.  The  filter  gain  matrix  K^ 
is  stored  in  vector  FLT  of  /CKF/ .  A  vector  of  the  standard 
deviations  of  the  state  estimates  (square-roots  of  the 
diagonal  elements  of  P  )  is  also  stored  in  FLT.  An  addi- 
tional  output  of  KFLTR  is  the  measurement  update  matrix 


Mk  '  (1  -  •'FSa’ 


(A-60) 


It  is  put  into  temporary  storage  in  vector  COM2  of  /MAIN2/ 
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for  use  in  the  filter  evcduation  routines. 

The  first  execution  of  FLTRK  in  a  given  run  of 

CGTPIF  uses  the  matrices  Q  and  R  of  equations  (A-21c) 

and  (A-4)  as  determined  from  initial  entry  of  the  design 

model.  Subsequent  executions  of  FLTRK  begin  by  offering 

the  user  an  opportunity  to  modify  the  system  noise  strength 

matrices  Q  and  (no  provision  is  made  for  direct  entry 

of  the  augmented,  discretized  noise  strength  matrix  Q  ) 

^d 

and  the  measxirement  noise  strength  R  of  equations  (A-3a)  , 
(A-3b) ,  and  (A-4) ,  respectively.  Routine  'QDSCRT'  is 
called  to  form  Q  (equation  (A-19d) )  and  compute  the  new 

di 

discrete-time  system  noise  covariance  matrix  Q  as  given 

®d 

by  equation  (A-21c) .  A  new  Kalman  filter  gain  matrix  is 
then  computed  as  described  above. 

A. 11. 8  FEVAL .  In  'FEVAL'  the  eigenvalues  of  the 
design  model-Kalman  filter  system  are  computed  with  a  call 
to  POLES.  The  primary  evaluation  tool  is  a  covariance 
euialysis  of  the  filter  in  which  the  filter's  estimation 
error  is  evaluated  in  operating  on  measurements  taken  from 
the  truth  model.  These  "true"  estimation  error  standard 
deviations  are  plotted  along  with  the  filter's  confuted 
error  standard  deviations . 

The  poles  of  the  system  with  filter  are  the  eigen¬ 


values  of 


1 


where  K^.,  and  are  given  by  equations  (A-60)  , 

(A-21a) ,  (A- 59) ,  and  (A-24) ,  respectively. 

The  covariance  analysis  entails  propagation  of  an 
error  covariance  matrix  through  fifty  filter  (controller) 
sanple  periods.  At  each  time  sample  a  vector  of  true  and 
filter  computed  estimation  error  standard  deviations  is 
written  to  the  PLOT  file.  When  the  run  is  complete  these 
are  plotted  pairwise  (true/computed)  for  each  state  in 
a  series  of  plots  to  the  LIST  file.  The  final  RMS  errors 
for  each  state  are  also  printed  at  the  user  terminal. 

Define  an  augmented  state  vector 


(A-62) 


with  X.  the  truth  model  states  and  x  the  filter  state 
— t  — 

estimates.  Time  propagation  for  the  augmented  state  is 
given  by 


(A-63) 


where 


(A-64a) 


and  w  is  zero-mean  white  Gaussian  discrete-time  noise  of 
discrete-time  noise  covariance 
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(A-64b) 


E(w  (ti)wj  (t  ))  . 
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with 


'd  *'0 


(T-T)^Q^^l^(T-T)dT 


(A-64C) 


and 


(A-64d) 


In  these  equations  ^  ,  $  ,  Q  ,  and  G  are  from  equations 
(A-28a) ,  (A-21a) ,  (A-8a) ,  and  (A-7a) ,  respectively. 

Note  that  equation  (A-64c)  is  actually 


(A-65) 


where  Q  is  determined  according  to  equation  (A-28c) . 

^d 

FEVAL  uses  Q  directly  rather  than  form  the  larger  matrix 
^d 


The  measurement  update  equation  is, 


(A-66) 


in  which 


^c 


I  I  O 

-- --H - Z-— 


(A-67a) 


(A-67b) 


Initial  conditions  for  x  (t]^)  are  taken  as  the  zero 

u 

vector . 


The  covariance  of  the  augmented  state  is 

assumed  to  be  zero  at  the  initial  time  (P  (t^) )  and  is 

— c  u 

propagated  forward  by 


Qc  (A-68a) 

d 

and 

Pc<^i)  =  (A-68b) 


Note  that  in  equation  (A-68b) 


T 

K  R^K  = 
— c-t— c 


0  I  0 

0  J  Kp-t-F 


(A-69) 


FEVAL  forms  the  lower  right  partition  of  equation  (A-69) 

T 

rather  than  forming  the  larger  matrix  . 

The  filter  estimation  error  for  the  design  model's 
system  and  disturbance  states  following  measurement  update  is. 


(A-70) 


with 


V 


(A-71a) 
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and 


Ct  =  [Tut  •  (A-7ib) 

in  which  and  are  as  defined  by  equations  (A-7c) 
and  (A-7d) . 

The  estimation  error  covariance  at  each  sample 
period  is  thus 

P  (tj  =  C  P  (t;!’)^  (A-72) 

— e  1  — c— c  1  — c 

The  diagonal  elements  of  are  the  vciriances  of  the  esti¬ 
mation  error  for  each  system  and  disturbance  state. 

Taking  the  square-root  of  each  to  obtain  the  standard 
deviations,  these  and  the  standard  deviations  from  the 
filter's  computed  covariance  matrix  are  written  to  the 
PLOT  file  at  each  sample  time . 

Routine  'DACOV  forms  matrix  of  equation 
(A-71a)  and  then  computes  according  to  equation 

(A-72) .  The  true  and  filter  computed  standard  deviations 
of  the  estimation  error  are  then  determined  and  written  to 
the  PLOT  file. 

Routine  'ACOVUD'  first  forms  matrix  ^  of  equation 

+  T 

(A-64a)  .  The  product  $  P  (t._,)4>  is  then  obtained  and 

is  added  to  its  upper  left  partition  to  give  as 

d 

in  equation  (A-68a) .  Next  the  matrix  ^  of  equation 

-  T 

(A-6  7a)  is  formed.  Then,  after  computing  (t.)A 
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the  product  KpR^Kp  is  added  to  its  lower  right  partition 
to  obtain  P  (tt)  of  equation  (A-68b) . 

The  adding  of  a  given  matrix  to  a  partition  of 
cuiother  as  required  for  equations  (A-68a)  and  (A-68b)  is 
accomplished  by  routine  'FPADD' .  Input  arguments  to  FPADD 
specify  the  size  of  the  partition  to  be  dealt  with  ("NRY"- 
by-"NCY")  and  the  starting  address  of  that  partition 
("LADDR")  in  the  large  matrix. 

FEVAL  calls  DACOV  initially  to  determine  the  errors 
at  time=0.,  then  calls  ACOVUD  and  DACOV  repeatedly  in  a 
loop  to  obtain  the  errors  at  each  time  sample.  When  these 
samples  are  completed,  plots  of  the  results  are  output  to 
the  LIST  file  using  calls  to  PLOTLP  for  each  state.  The 
RMS  errors  at  the  final  time  sample  are  printed  at  the 
terminal  for  each  state. 

A.  11.9  Utility  Routines.  CGTPIF  includes  a 
number  of  routines  which  perform  specific  computations 
useful  to  several  of  the  larger  computational  elements 
discussed  in  Sections  A. 11 . 2-A. 11 . 8  above.  Each  routine 
will  be  discussed  briefly.  The  function  performed  and  the 
input/ output  arguments  will  be  delineated.  In  a  few  cases 
variable  "LABORT"  (signifying  abort  of  program  execution) 
of  /DESIGN/  or  the  model  dimensions  of  /NDIMD/ ,  /NDIMC/ , 
or  /NDIMT/  are  modified;  in  all  other  cases  only  varicibles 
appearing  as  formal  arguments  are  modified  by  the  sub¬ 


routines. 


RSYS  (A,  L,  ND,  ITYPE,  IWRT) 

Routine  'RSYS'  is  used  in  entering  any  of  the  three 
dynamic  models  describing  the  design  problem.  It 
distinguishes  among  the  models  it  is  dealing  with 
and  provides  prompts  to  the  user  appropriate  to 
each.  Its  formal  arguments  are: 

"A";  Output  vector  containing  all  arrays 

defining  the  dynamic  model. 

"L" :  Output  vector  containing  the  starting 

addresses  of  each  array  within  vector  A. 
The  order  of  the  array  starting  addresses 
is  the  same  as  in  equations  (A-6) ,  (A-10) 
or  (A-13) . 

"ND":  Output  vector  used  internally  by  RSYS  to 

store  the  dimensions  of  the  model  being 
entered.  The  order  of  the  dimensions  is 
the  same  as  in  equations  (A- 5) ,  (A-9) , 
or  (A-12) . 

"ITYPE":  Input  integer  scalar  signifying  the  model 

to  be  entered.  Values  of  1,  2,  or  3 
refer  to  design,  command,  or  truth  models 
respectively . 

"IWRT":  Input/output  integer  scalar  indicating  if 

specific  model  has  been  previously 
entered,  and  if  so  if  it  has  been  written 
to  the  SAVE  file.  For  IWRT  non-zero  the 
model  has  been  successfully  entered;  for 
IWRT  negative  the  model  has  also  been 
written  to  SAVE.  IWRT  is  initialized  to 
zero  by  the  calling  routine  and  set  to 


values  by  RSYS  to  control  its  functioning 
in  subsequent  calls  dealing  with  the  same 
model . 


DSND  (ND) 

Routine  'DSND*  is  a  dummy  routine  of  the  same  name 
as  an  optional  routine  described  in  Section  A. 10. 

It  is  loaded  if  the  user  does  not  include  the 
corresponding  functional  routine.  It  sets  the  first 
dimension  of  the  model  to  zero,  signaling  RSYS  that 
■i  "real"  routine  does  not  exist. 

"ND":  Output  vector  intended  to  contain  model 

dimensions.  Its  first  element  is  set  to 
zero. 

CMDD  (ND) 

Same  as  for  DSND. 

TRTHD  (ND) 

Same  as  for  DSND. 

DSNM  (A,  B,  EX,  G,  Q,  C,  DY,  EY,  H,  HD,  R,  AN,  GN,  QN) 
Routine 'DSNM'  is  a  dummy  routine  of  the  same  name 
as  an  optional  routine  described  in  Section  A. 10. 

It  merely  "completes  the  load"  in  the  event  the  user 
elects  not  to  include  the  functional  routine. 

CMDM  (AM,  BM,  CM,  DM) 

Same  as  for  DSNM. 

TRTHM  (AT,  BT,  GT,  QT,  HT,  RT,  TDT,  TNT) 


Same  as  for  DSNM. 


DSNDM  (ND,  NAD) 

Routine  'DSNDM'  sets  values  into  the  design  model 
dimension  veuriahles  of  /NDIHD/.  It  also  stores  the 
array  dimensionalities  of  the  model  into  a  two- 
dimensional  array  for  use  by  RSYS.  Finally,  it 
tests  to  determine  if  sufficient  allocation  has 
been  provided  in  vector  DM  of  /DSNMTX/;  if  not, 
LABORT  of  /DESIGN/  is  set  to  flag  allocation 
error . 

"ND":  Input  vector  of  model  dimensions. 

"NAD":  Output  array  of  model  matrix  dimensions. 

Columns  1  and  2  are  the  [row, column] 
dimensions  of  each  matrix  in  the  order 
of  the  arguments  of  DSNM.  For  example, 
matrix  "B"  is  argument  2  and  is  of  dimen¬ 
sion  (n-by-m) ;  thus  DSNDM  sets  NAD(2,l)=n 
and  NAD(2,2)=m. 

CMDDM  (ND,  NAD) 

Same  as  for  DSNDM  but  for  command  model  and  common 
blocks  /NDIMC/  and  /CMDMTX/  are  used. 

TRTHDM  (ND,  NAD) 

Same  as  for  DSNDM  but  for  truth  model  and  common 
blocks  /NDIMT/  and  /TRUMTX/  are  used. 

ZMATIN  (A,  NR,  NC,  IZ) 

Routine  'ZMATIN'  is  used  to  read  in  matrices 
entered  by  specifying  the  element  address  (row, 
column)  and  value.  If  an  entry  is  attempted  that 
is  not  in  array  bounds,  a  message  is  printed  and  the 
entry  not  accepted.  A  row  entry  of  zero  signals 
end  of  array  entries. 
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"A":  Input/output  array  in  full  storage  mode. 

"NR":  Input  integer  scalar  specifying  row  dimen¬ 

sion  of  A. 

"NC":  Input  integer  scalar  specifying  column 

dimension  of  A. 

"IZ":  Input  integer  scalar  affecting  execution 

of  ZMATIN.  For  IZ  positive,  matrix  A  is 
first  zeroed.  For  IZ  negative,  A  is 
constrained  to  be  symmetric. 

WFILED  (NT,  NP,  ND,  A) 

Routine  'WFILED*  is  used  to  write  data  to  the  SAVE 
file.  It  executes  four  writes:  (1)  a  pair  of 
integer  scalars  specifying  the  data  code  and  the 
nuirber  of  data  points;  (2)  an  integer  vector  of 
length  ten  with  the  dimensions  of  the  model  in  data; 
(3)  a  real  vector  containing  data  arrays;  and  (4)  a 
pair  of  integer  scalars,  the  first  indicating  end 
of  data  on  SAVE  file,  the  second  a  dummy.  The  end 
of  data  code  (-1)  is  written  on  SAVE  initially  by 
CGTXQ;  each  execution  of  WFILED  begins  with  a 
"backspace"  on  SAVE  to  allow  the  already  existing 
end  of  data  code  to  be  overwritten.  This  ensures 
that  the  SAVE  file  data  entries  can  be  successfully 
read  when  used  as  a  DATA  file. 

"NT":  Input  integer  scalar  data  code.  Values 

of  1,  2,  3,  or  4  correspond  to  design 
model,  command  model,  truth  model,  or  PI 
gains,  respectively. 
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”NP":  Input  integer  scalar  specifying  number  of 

data  elements  in  data  vector. 

"ND":  Input  integer  vector  of  dimensions. 

"A":  Input  real  vector  storing  data  to  be 

saved . 

READFS  (A,  ND,  NT,  lERR) 

Routine  'READFS*  reads  data  from  the  DATA  file  which 
was  written  by  WFILED.  It  searches  the  DATA  file 
for  the  code  of  the  data  set  it  is  to  read.  If  the 
data  set  is  found,  a  call  to  'FARRAY'  reads  the 
data.  If  not  found,  a  message  is  written  and  an 
error  flag  set. 

"A";  Output  real  vector  of  array  data. 

"ND":  Output  integer  vector  of  dimension  data. 

"NT":  Input  integer  scalar  specifying  data  set 

code  (as  for  "NT"  in  WFILED) . 

"lERR":  Output  integer  scalar  error  flag  set  non¬ 

zero  if  data  set  is  not  found  on  DATA 
file . 

FARRAY  (A,  ND,  NP) 

Routine  'FARRAY'  reads  data  sets  from  the  DATA  file. 

"A":  Same  as  "A"  in  READFS. 

"ND":  Same  as  "ND"  in  READFS. 

"NP":  Input  integer  scalar  specifying  nurdser  of 

data  elements  in  data  vector  A. 


TFRMTX  (XI,  X2,  NR,  NC,  ITX) 

Routine  'TFRMTX*  transfers  matrices  between  storage 
locations  in  cases  when  one  matrix  is  in  full 
storage  mode  and  the  other  is  in  variable  storage 
mode.  The  transfer  Ccui  be  in  either  direction  as 
determined  by  an  input  argument. 

"XI":  Input/output  real  array  in  full  storage 

mode.  It  is  allocated  (NR-by-NC) . 

"X2":  Input/output  real  array  in  variable 

storage  mode.  It  is  allocated  (NDIM-by- 
NDIM)  but  contains  an  array  sized  (NR-by~ 
NC) .  Note  that  "NDIM"  is  the  row  dimen¬ 
sion  specification  of  /MAINl/. 

"NR";  Input  integer  scalar  row  dimension. 

"NC":  Input  integer  scalar  column  dimension. 

"ITX":  Input  integer  scalar  controlling  the 

direction  in  which  the  matrix  transfer 
takes  place.  For  ITX=1,  X2  is  the  input, 
XI  is  the  output,  and  the  (NR-by-NC) 
sub-array  of  X2  is  stored  in  XI.  For 
ITX=2,  XI  is  the  input,  X2  is  the  output, 
and  the  matrix  XI  is  stored  as  an  (NR-by- 
NC)  sub-array  in  X2. 

MATLST  (A,  NR,  NC,  NT,  KDEV) 

Routine  'MATLST'  is  used  to  output  arrays  in  full 
storage  mode.  A  name  is  printed  specifying  the 
array. 


74 


I 


"A":  Input  real  array  in  full  storage  mode. 

"NR":  Input  integer  scalar  row  dimension  of  A. 

"NC":  Input  integer  scalar  column  dimension  of 

A. 

"NT":  Input  integer  scalar  with  an  array  name 

of  three  or  fewer  characters, 

"KDEV" :  Input  integer  scalar  output  device  number . 

NDSCRT  (A,  N,  NTERMS) 

Routine  'NDSCRT'  computes  the  number  of  terms  to  be 
used  in  computing  a  state  transition  matrix  using 
a  series  expansion.  It  uses  a  method  suggested  in 
Reference  11  (but  with  a  maximum  of  30  terms  in 
the  expansion  because  a  temporary  vector  in  DSCRT  has 
its  dimension  fixed  at  30) .  The  number  of  terms  is 
selected  to  achieve  a  truncation  error  of  less  than 
l.E-6. 

"A":  Input  real  array. 

"N":  Input  integer  scalar  dimension  of  A. 

"NTERMS":  Output  integer  scalar  specifying  number 

of  terms  to  be  used  in  expansion  approxi- 
AT 

mating  e—  . 

RQWGTS  (W,  ND,  NP) 

Routine  'RQWGTS'  is  used  to  enter  the  diagonal 
elements  of  the  quadratic  weighting  matrices  or 
noise  covariance  matrices.  Elements  are  specified 
using  a  single  index  for  the  diagonal  element  and 


the  value  of  that  element.  The  index  is  tested  for 
being  in  array  bounds,  and  negative  entries  for 
diagonal  elements  are  not  accepted.  For  either 
error  a  message  is  written.  A  diagonal  index  of 
zero  signals  that  entry  is  complete.  Elements  are 
tested  for  proper  sign  according  to  argument  "NP". 

"W" :  Input/output  real  array  whose  diagonal 

elements  are  to  be  set. 

"ND":  Input  integer  scalar  specifying  the  row 

dimension  of  the  array  within  which  W  is 
stored. 

"NP";  Input  integer  scalar  used  to  determine 

sign  test  for  diagonal  elements.  If  zero 
diagonal  elements  may  be  greater  than  or 
equal  to  zero.  If  NP  is  non- zero, 
diagonal  elements  must  be  positive. 

DVCTOR  (N,  A,  V) 

Routine  'DVCTOR'  extracts  the  diagonal  elements  of 
an  array  and  stores  them  in  a  vector. 

"N";  Input  integer  scalar  dimension  of  input 

array . 

"A";  Input  real  array. 

"V" :  Output  real  vector  of  diagonal  elements 

of  A. 

POLES  (A,  N,  ITYPE,  ZMl,  ZM2) 

Routine  'POLES'  computes  the  eigenvalues  of  the 
input  matrix  using  'EIGEN'  of  LIBRARY.  For  the 


6 


design,  conunand,  and  truth  models  it  coit^jutes  the 
poles  of  the  continuous-time  system  model.  For  the 
PI  and  filter  closed-loop  systems,  it  computes  the 
discrete-time  poles  then  calls  'MAPOLE'  to  map  them 
to  the  primary  strip  in  continuous-time.  The  con¬ 
tinuous  or  pseudo-continuous- time  poles  are  printed 
along  with  a  title  identifying  the  system. 


"A":  Input  real  array. 

"N":  Input  integer  scalar  dimension  of  A. 

"ITYPE":  Input  integer  scalar  indicating  system 

represented  by  A.  Values  of  1  to  5  refer 
to  the  design,  command,  or  truth  models, 
the  closed-loop  PI,  or  filter  systems, 
respectively. 

"ZMl",  ''ZM2":  Input  real  arrays  used  for  temporary 
storage . 


MAPOLE  (N,  ZR,  ZI,  T) 

Routine  'MAPOLE'  is  used  to  map  the  poles  of  a 
discrete-time  system  to  the  primary  strip  in  the 
continuous  domain  (Ref  28) .  Denote  the  real  (o) 
cind  imaginary  (w)  parts  of  a  discrete-time  pole 
as  Zr,  and  a  respectively.  MAPOLE  uses  the  follow- 
ing  equations ; 


z 


m 


(A-73a) 


a  =  LOG  (a  )/T  (A-73b) 

e  m 

oj  =  TAN"^(  /T  (A-73c) 
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where  T  is  the  controller-filter  sample  period  emd 
o  and  0)  are  the  corresponding  mapped  real  and 
imaginary  parts  of  the  pole.  These  computations 
are  performed  for  each  system  pole. 

"N";  Input  integer  scalar  number  of  eigen¬ 

value  s . 

"ZR";  Input/output  real  vector  of  real  com¬ 

ponents  of  poles  (2j^)  . 

"ZI":  Input/output  real  vector  of  imaginary 

components  of  poles  (a^)  . 

"T":  Input  real  scalar  controller-filter’ 

sample  period  (T) . 

LADDR  (NR,  I,  J) 

Function  routine  'LADDR'  computes  the  single  index 
address  of  an  element  specified  by  a  (row,  column) 
address  within  an  array.  That  index  value  is 
stored  in  function  name  LADDR. 

"NR";  Input  integer  scalar  row  dimension  of 

array  within  which  an  address  is  sought. 

"I":  Input  integer  scalar  element  row  address. 

"J";  Input  integer  scalar  element  column 

address . 

FTMTX  (X,  Y,  NR,  NC) 

Routine  'FTMTX'  transfers  one  array  to  storage  in 
another  when  both  are  in  full  storage  mode. 
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"X":  Input  real  array  whose  elements  are  to 

be  stored  elsewhere. 

"Y":  Output  real  array  containing  same  ele¬ 

ments  as  X. 

"NR" ;  Input  integer  scalar  row  dimension  of 

x,y. 

"NC":  Input  integer  scalar  column  dimension  of 

X, Y. 

FMMUL  (X,  Y,  NRl,  NCl,  NC2,  Z) 

Routine  'FMMUL'  computes  the  product  of  two  matrices. 
All  matrices  are  in  full  storage  mode. 

"X":  Input  real  array  dimensioned  (NRl-by-NCl) . 

"Y":  Input  real  array  dimensioned  (NCl-by-NC2) . 

"NRl" :  Input  integer  scalar  row  dimension  of  X. 

"NCI":  Input  integer  scalar  column  dimension  of 

X  and  row  dimension  of  Y. 

"NC2":  Input  integer  scalar  column  dimension  of 

Y. 

"Z";  Output  real  array  formed  as  product  of 

X  eind  Y  and  dimensioned  (NRl-by-NC2)  . 

FTMUL  (X,  Y,  NRl,  NCI,  NC2,  Z) 

Routine  'FTMUL'  computes  the  product  of  one  matrix 
with  the  transpose  of  another.  All  arrays  are  in 
full  storage  mode. 
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"X";  Input  real  array  dimensioned  (NRl-by-NCl) 

"Y":  Input  real  array  dimensioned  (NRl-by-NC2) 

"NRl",  "NCI",  "NC2":  Input  integer  scalar  dimen¬ 
sions. 

"Z":  Output  real  array  formed  as  product  of 

with  Y;  it  is  dimensioned  (NCl-by-NC2) 

FMADD  (X,  Y,  NR,  NC,  Z) 

Routine  'FMADD'  computes  the  sum  of  two  matrices. 
All  matrices  are  in  full  storage  mode.  Either 
input  matrix  can  be  equivalent  to  the  output 
matrix. 

"X";  Input  real  array  dimensioned  (NR-by-NC) . 

"Y":  Input  real  array  dimensioned  (NR-by-NC). 

"NR",  "NC";  Input  integer  scalar  dimensions. 

"Z":  Output  real  array  formed  as  the  sum  of  X 

eind  Y  and  dimensioned  (NR-by-NC)  . 

ZPART  (A,  NR,  NC,  ND) 

Routine  'ZPART'  is  used  to  store  zeros  in  a  parti¬ 
tion  of  a  matrix  which  is  itself  in  full  storage 
mode . 

"A" :  Input/output  real  array  of  row  dimension 

"ND";  the  first  element  of  A  is  the  start 
ing  location  of  the  partition  to  be 
zeroed . 
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"NR" :  Input  integer  scalar  row  dimension  of  the 

partition. 

"NC":  Input  integer  scalar  column  dimension 

of  the  partition. 

"ND":  Input  integer  scalar  row  dimension  of  the 

input  matrix  A. 

SUBI  (A,  NR,  ND) 

Routine  'SUBI*  is  used  to  subtract  an  identity 

matrix  of  appropriate  dimension  from  a  square  parti¬ 
tion  of  a  larger  matrix  in  full  storage  mode. 

"A":  Input/output  array  of  row  dimension  "ND"; 

the  first  element  of  A  is  the  starting 
location  of  the  square  partition. 

"NR";  Input  integer  scalar  dimension  of  the 
square  partition. 

"ND" :  Input  integer  scalar  row  dimension  of  the 

input  matrix  A. 


WPLOTF  (V,  N) 

Routine  'WPLOTF'  writes  a  vector  to  the  PLOT  file. 
"V":  Input  real  vector. 

"N":  Input  integer  scalar  dimension  of  V. 

RPLOTF  (V,  N,  lERR) 

Routine  'RPLOTF'  reads  a  vector  from  the  PLOT  file. 
If  an  "end-of-file"  is  encountered  in  the  read  an 
error  flag  is  set. 


Output  real  vector. 


"V": 

"N";  Input  integer  scalar  dimension  of  V. 

"lERR";  Output  integer  scalar  error  flag.  lERR 
is  non- zero  if  an  error  occurred. 

STRPLT  (A,  V,  NS/  NV/  NP,  NVO) 

Routine  'STRPLT*  extracts  specific  elements  from 

an  input  vector  and  stores  them  in  an  output  vector. 

It  is  used  in  preparing  sets  of  variables  for 

plotting . 

"A" :  Output  real  vector  into  which  elements 

are  stored. 

"V":  Input  real  vector  some  of  whose  elements 

are  extracted  for  storage  in  A. 

"NS";  Input  integer  vector  of  addresses  where 
variables  are  to  be  stored  within  A. 

"NV" :  Input  integer  vector  of  element  addresses 

of  variables  in  V  which  are  to  be  extracted. 

"NP";  Input  integer  scalar  specifying  nuniber  of 

variables  to  be  extracted  from  V. 

"NVO";  Input  integer  scalar  length  of  vector  V. 

It  also  locates  the  storage  of  the  time 
variable  in  V  (time  is  the  last  element 
of  V)  . 
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PLOTLP  (N,  M,  A,  IPSC,  ISCL,  LPTERM,  NDEV,  ITITLE) 
Routine  'PLOTLP*  creates  line  printer  plots.  As 
many  as  five  dependent  variables  may  be  plotted 
with  respect  to  a  single  independent  variable. 

Every  sample  of  the  independent  variable  is  plotted, 
and  runs  lengthwise  on  the  output  listing.  The 
dependent  variables  are  plotted  over  a  field  either 
50  or  100  print  positions  in  width  and  may  be 
unsealed,  scaled  individually,  or  scaled  separately. 
Each  dependent  varieible  is  plotted  with  an  integer 
identifier  (1  to  5) .  The  range  of  the  plot  is 
printed  with  subdivisions,  and  if  independent 
scaling  is  used  multiple  ranges  are  printed  and 
marked  in  correspondence  to  the  plot  symbol  of  the 
variable  to  vdiich  it  pertains.  Header  comments  in 
the  source  listing  define  all  argviments  explicitly. 
Those  descriptions  will  not  be  repeated  here. 

VARSCL  (XMIN,  XMAX,  SCALE,  RSPACE,  ISCL) 

Routine  'VARSCL'  is  used  by  routine  PLOTLP  to 
achieve  scaling  of  the  plot  vairiables.  It  can  give 
either  exact  scaling  so  that  the  full  range  of  the 
variable  is  used  or  a  "nice"  scaling  with  upper  and 
lower  values  of  the  range  and  the  scale  increment 
all  simple  numbers.  In  the  former  case  maximum 
resolution  is  achieved  but  computation  of  inter¬ 
mediate  values  in  the  range  involve  numbers  that 
require  many  digits  to  specify.  In  the  latter  case, 
resolution  may  be  lessened  but  the  computations  to 
determine  intermediate  values  are  simpler.  Equal 
scaling  is  achieved  by  scaling  over  the  combined 
range  of  all  variables. 


"XMIN";  Input/output  real  scalar  giving  the  mini¬ 
mum  value  of  the  variable. 

"XMAX" :  Input  real  scalar  giving  the  maximum  value 

of  the  variable. 

"SCALE":  Output  real  scalar  giving  the  scale  size 
of  each  print  position  in  the  range. 

"RSPACE":  Input  real  scalar  specifying  the  number 
of  print  positions  in  the  plot  range. 

"ISCL":  Input  integer  scalar  indicating  if  exact 

or  "nice"  scaling  is  to  be  used.  ISCL 
non-zero  gives  "nice"  scaling. 

A. 12  LIBRARY  Routines 

Many  routines  of  LIBRARY  are  called  by  CGTPIF. 

Many  others  are  invoked  by  those  vdiich  are  explicitly 
called.  For  descriptions  of  all  the  LIBRARY  routines  see 
Reference  24 .  Some  general  considerations  in  using  these 
routines  will  be  discussed  here. 

In  essence,  the  LIBRARY  package  of  routines 
assumes  that  arrays  used  in  its  computations  are  in  vari¬ 
able  storage  mode  within  larger  square  arrays  of  dimension 
NDIM  (NDIM  is  an  element  of  /MAINl/) .  Because  of  the 
method  of  array  storage  in  FORTRAN  (column-major  storage) 
in  most  cases  only  the  allocated  row  dimension  of  all 
arrays  involved  in  computations  must  be  identical.  During 
some  operations  involving  matrix  transposes,  the  allocation 


must  actually  be  square  for  the  matrix  which  is  treins- 
posed. 

Thus,  in  all  execution  of  CGTPIF  other  than  'MAIN', 
NDIM  at  any  specific  time  is  set  to  the  row  dimension  of 
the  allocation  in  which  relevant  arrays  are  effectively 
stored  for  the  computations  currently  using  LIBRARY 
routines.  The  variable  "NDIMl"  of  /MAINl/  is  simply  the 
value  of  NDIM  plus  one.  Both  NDIM  and  NDIMl  are  used  by 
the  routines  of  LIBRARY  to  locate  specific  elements  of 
arrays. 

Sometimes  arrays  involved  in  LIBRARY  calls  are  row 
dimension  compatible  in  their  existing  storage  mode.  At 
other  times  some  arrays  must  be  moved  to  a  variable  storage 
mode  of  row  dimension  equal  to  that  of  the  largest  array 
to  be  used  so  that  all  arrays  involved  in  a  computation 
are  effectively  stored  in  arrays  of  equal  allocation  dimen¬ 
sions  . 

CGTPIF  does  a  great  deal  of  array  manipulation. 

The  routines  of  the  LIBRARY  provide  very  useful  capabili¬ 
ties  and  should  be  used  when  possible.  However,  the  pro¬ 
grammer  should  be  very  careful  to  deal  properly  with  array 
storage  in  attempting  modification  of  CGTPIF  or  calls  to 
LIBRARY  from  optional  routines.  It  is  easy  to  be  correct, 
but  it  is  also  easy  to  be  incorrect  since  programmers 
typiccilly  are  unaccustomed  to  the  manner  in  which  FORTRAN 
stores  arrays. 


A. 13 


Array  Starting  Addresses 

Throughout  CGTPIF  arrays  are  referenced  in  terms 
of  single  index  addresses.  These  may  be  the  starting 
addresses  of  arrays  within  larger  vectors  or  may  be 
addresses  of  specific  elements  of  arrays.  With  the  spe¬ 
cific  exception  of  the  variables  in  /DESIGN/,  essentially 
all  variables  used  in  CGTPIF  conform  to  the  following  con¬ 
vention:  variable  names  beginning  with  the  character  "L" 
refer  to  array  address  indexing.  Many  such  index  variables 
are  of  temporary  use  only  and  can  be  evaluated  in  the  con¬ 
text  of  the  source  code  where  they  occur. 

The  starting  addresses  of  all  arrays  preserved  in 
Common  storage  are  stored  in  variables  of  associated 
Commons.  These  starting  address  Commons  are  described 
below.  In  all  cases,  arrays  are  stored  in  the  associated 
vector  storage  area  in  the  same  order  in  which  their 
starting  addresses  occur  in  the  corresponding  address 
Commons.  In  identifying  array  addresses  below,  the  equa¬ 
tion  number  in  which  each  array  is  defined  is  given  in 
parentheses  to  the  right  of  the  array  name. 

/LOCD/  LAP,  LGP,  LPHI,  LED,  LEX,  LPHD,  LQ,  LQN,  LQD, 

LC,  LDY,  LEY,  LHP,  LR 

Address  Common  /LOCD/  is  associated  with  /DSNMTX/ 
(see  Sections  A. 6. 4.1  and  A. 7.1)  and  specifies 
starting  addresses  within  vector  "DM"  as  follow: 
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m 


"LAP" : 

(A-19a) 

"LGP"; 

^a 

(A-19c) 

"LPHI": 

(A-22a) 

"LED": 

(A-22b) 

"LEX": 

(A-22a) 

"LPHD": 

4 

— n 

(A-22a) 

"LQ"; 

Q 

(A-3a) 

"LQN": 

Sn 

(A-3b) 

"LQD": 

^a 

^d 

(A-21c) 

"LC": 

C 

(A-23c) 

» 

"LDY": 

(A-23c) 

1 

s 

"LEY": 

% 

(A-23c) 

i 

V 

"LHP": 

(A-24) 

«• 

"LR": 

R 

(A-24) 

1 

/LOCC/  LPHC, 

LBDC, 

LCC,  LDC 

'■ 

Address 

Common 

/LOCC/  is  associated  with  /CMDMTX/ 

(see  Sections  A. 6. 4.1  and  A. 7.3)  and  specifies  array 

i 

( 

starting 

addresses  within  vector  "CM"  as  follow: 

s 

"LPHC ": 

$ 

— m 

(A-25a) 

"LBDC": 

B 

-md 

(A-25b) 

i 

"LCC"; 

C 

— m 

(A-26a) 

1 

"LDC ": 

D 

— m 

(A-26b) 

/LOCT/  LPHT, 

LBDT, 

LQDT,  LHT,  LRT,  LTDT,  LTNT 

Address 

Common 

/LOCT/  is  associated  with  /TRUMTX/ 

(see  Sections  A. 6. 4.1  and  A. 7. 2)  and  specifies 
starting  addresses  within  vector  "TM"  as  follow: 
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"LPHT": 

-t 

(A-28a) 

"LBDT" : 

®t, 

d 

(A-28b) 

"LQDT"; 

% 

(A-28C) 

"LHT": 

(A- 7b) 

"LRT": 

5t 

(A-8b) 

"LTDT": 

-DT 

(A- 7c) 

"LTNT": 

-NT 

(A-7d) 

/LCNTRL/  LPIll,  LPI12, 

LPI21,  LPI22, 

LPHDL,  LBDL 

Address  i 

Coiranon  /LCNTRL/  is  associated 

with  /CONTROL/ 

(see  Sections  A. 6. 4 

.2  and  A. 11. 3) 

cmd 

specifies 

starting 

addresses 

within  vector 

"CTL 

"  as  follow; 

"LPIll": 

-11 

(A-29b) 

"LPI12": 

-12 

(A-29b) 

"LIP21": 

^21 

(A-29b) 

"LIP22": 

^22 

(A-29b) 

"LPHDL": 

(A-30a) 

"LBDL"; 

(A-30b) 

/LREGPI/  LXDW,  LUDW,  LPHCL,  LKX,  LKZ 

'  Address  i 

Common  /LREGPI/  is  associated 

with  /CREGPI/ 

(see  Sections  A. 6. 4 

.3  and  A. 11.4) 

and 

specifies 

starting 

addresses 

within  vector 

"RPI' 

"  as  follow: 

"LXDW" ; 

Y 

(A-32a) 

"LUDW" ; 

He 

(A-34) 

"LPHCL"; 

-6CL 

(A-44) 

"LKX"; 

K 

(A-48a) 

—X 

"LKZ": 

K 

—2 

(A-48b) 
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/LCGT/  LAll, 

LAI 3,  LA21, 

LA23,  LA12,  LA22,  LKXAll, 

LKXA12 

,  LKXA13 

Address  Common  /LCGT/ 

is  associated  with  /CCGT/ 

(see  Sections  A. 6. 4. 4 

and  A. 11. 5)  and  specifies 

starting 

addresses  within  vector  "CGT"  as  follow 

"LAll": 

All 

(A-51a) 

"LA13"; 

-13 

(A-51c) 

"LA21": 

-21 

(A-51d) 

"LA23": 

-23 

(A-51f) 

"LA12": 

-12 

(A-51b) 

"LA22": 

-22 

(A  51e) 

"LKXAll": 

K 

V 

(A-53a) 

A 

m 

"LKXA12"; 

K 

'•V 

(A-53b) 

"LKXA13": 

(A-53C) 

n 

/LKF/  LEADSN, 

LFLTRK,  LFCOV 

Address  Common  /LKF/ 

is  associated  with  /CKF/ 

(see  Sections  A. 6. 4. 5 

and  A. 11. 7)  and  specifies 

starting 

addresses  within  vector  "FLT"  as  follow 

"LEADSN": 

$ 

—a 

(A-21a) 

"LFLTRK": 

(A-59) 

"LFCOV": 

(A-58) 
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Appendix  B 


CGTPIF  User’s  Guide 


B.l  Introduction 

CGTPIF  is  an  interactive  program  for  designing 
"Command  Generator  Tracker"  control  systems.  It  provides 
three  design  options:  (1)  design  of  a  Proportional-plus 
Integral  (PI)  regulator;  (2)  design  of  an  open-loop  (CGT) 
or  closed-loop  (CGT/PI)  Commemd  Generator  Tracker  con¬ 
troller;  and  (3)  design  of  a  Kalman  filter.  These  provide 
the  component  designs  for  the  final  controller,  to  be 
implemented  as  a  Command  Generator  Tracker,  with  an  inner- 
loop  Proportional-plus-integral  regulator,  and  a  Kalman 
filter  for  state  estimation  (CGT/PI/KF) .  Corresponding  to 
each  design  option  is  a  set  .of  routines  for  evaluation  of 
the  quality  of  the  design.  During  progreun  execution,  any 
of  the  design  paths  can  be  pursued  in  cuiy  order  and  as 
often  as  desired. 

This  "User's  Guide"  discusses  CGTPIF  as  an  exist¬ 
ing  program  (as  it  executes  under  CYBER  INTERCOM)  and  with 
the  intention  of  providing  information  appropriate  to  suc¬ 
cessful  execution  when  applied  to  the  user ' s  design  prob¬ 
lem.  It  discusses  program  operation  from  the  input/output 
(I/O)  perspective:  the  specific  input  and  output  of  each 
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design/evalxiatlon  path  and  the  terminology  employed  in 
each  input/output  item.  It  also  discusses  what  the  user 
must  do  both  before  and  immediately  following  program  exe¬ 
cution.  Users  interested  in  more  detailed  information 
about  the  operation  of  the  program  should  refer  to  the 
"CGTPIF  Programmer's  Guide”  (Appendix  A) . 

B.2  Preparation  Prior  to 

Program  Execution 

B.2.1  Determine  Dynamic s  Models .  CGTPIF  employs 
three  dynamics  models  for  the  system  design:  a  "design" 
model,  a  "tanath"  model,  and  a  "comnumd”  model.  It  is 
necessary  that  the  user  determine  the  dimensions  and 
parameters  of  these  models  prior  to  execution  of  the  pro¬ 
gram.  The  specific  models  needed  by  each  design  vary,  and 
only  those  needed  to  execute  the  design  paths  of  interest 
need  be  known. 

At  a  minimum,  the  design  model  must  be  known  in 
order  to  execute  auiy  of  the  designs.  The  truth  model  is 
required  for  evaluation  of  the  Kalman  filter  (to  perform  a 
covariance  analysis)  and  is  optional  for  evaluation  of  the 
PI  regulator  or  CGT  and  CGT/PI  controllers.  The  command 
model  must  be  known  in  order  to  effect  either  CGT  or 
CGT/PI  designs. 

The  dynamics  models  are  entered  into  the  program 
during  execution  as  needed  and  under  input  prompting  pro¬ 
vided  by  CGTPIF.  The  models  will  be  discussed  in  detail 
in  the  next  section  of  this  user's  guide. 
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B.2.2  Define  Objectives  and  Specifications . 

Before  embarking  upon  design  of  the  controller,  the 
designer  should  define:  (1)  the  objectives  vdiich  are  to  be 
sought,  emd  (2)  appropriate  ^ecifications  ^Uld  constraints 
to  apply  to  the  controller.  These  may  be  rather  loosely 
defined  initially,  then  become  more  specific  and  firm  as 
the  design  progresses. 

Objectives  will  vary  with  the  problem  under  con¬ 
sideration  but  might  be  exemplified  by  formulation  of  a 
desired  controlled  output  response  behavior.  For  exeunple, 
one's  objective  might  consist  of  achieving  decoupled,  first- 
order  responses  with  specified  characteristics  for  each 
controlled  output  of  a  given  multi-input  multi-output 
(MIMO)  system. 

Specifications  and  constraints  derive  from  the 
problem  application  and  from  the  objectives  for  the  design. 
Typical  considerations  include  time-delay,  overshoot,  and 
settling  time  of  the  response,  and  input  magnitude  and  rate 
limits . 

B.2.3  Determine  Appropriate  Initial  Quadratic 
Weights.  Execution  of  the  PI  regulator  design  entails 
entry  of  quadratic  weights  for  the  optimal  cost  function. 
Such  weighting  matrices  are  required  for  the  outputs,  the 
input  magnitudes,  and  the  input  rates  (Ref  32;  see  also 
Section  3.4.2  of  this  thesis).  For  these,  only  diagonal 
elements  are  required  as  input  since  CGTPIF  assumes  them 


to  be  diagonal  matrices.  However,  after  CGTPIF  computes 
the  resulting  augmented  state  and  input  magnitude  weighting 
matrix  (equation  (A~33) ) ,  the  user  may  modify  any  element 
of  it  to  achieve  design  goals. 

Although  final  selection  of  appropriate  qtiadratic 
weighting  values  to  achieve  design  requirements  is  achieved 
in  an  iterative  (trial-and-error ,  hopefully  with  insight) 
fashion,  it  is  possible  to  make  initial  choices  which  are 
plausible.  A  common  method  for  determining  initial 
quadratic  weights  involves  inverse  square  weighting  of 
maximum  deviations  of  outputs  and  inputs  to  achieve  regula¬ 
tion  for  an  assumed  perturbation  of  the  system  (Refs  2;  29; 

32) .  For  example,  the  diagonal  output  weighting  matrix 

2 

element  would  be  Y^^®1./ (maximum  allowable  y^^)  . 

Beginning  with  the  initial  set  of  quadratic  weights, 
the  PI  design  path  is  executed  repeatedly  with  changes  in 
the  choice  of  weighting  elements  until  the  design  is  satis¬ 
factory.  CGTPIF  provides  information  during  execution 
vdiich  allows  the  design  to  be  evaluated  and  iteration  of 
the  design  to  be  pursued  effectively. 

For  open-loop  CGT  designs  and  Kalman  filter  designs, 
preparation  consists  of  defining  the  various  dynamics 
models.  The  open-loop  CGT  design  depends  only  on  the  design 
and  command  models.  The  initial  execution  of  the  Kalman 
filter  design  path  depends  only  on  the  design  model  (and 
truth  model  for  evaluation) .  Further  refinements  to  either 


design  are  achieved  through  modification  of  the  appropriate 
dynamics  model  (command  or  design) . 

B.3  Definition  of  the 

Dynamics  Models 

Each  of  the  dynamics  models  entered  into  CGTPIF 
is  represented  by  a  set  of  continuous-time  state  differen¬ 
tial  equations.  A  summary  description  of  each  model  is 
given  here,  vAiile  more  detail  appears  in  Appendix  A.  The 
names  used  in  the  equations  to  follow  are  exactly  those 
used  by  CGTPIF  in  reference  to  these  same  dimensions  and 
arrays  in  its  I/O.  Note  that  here  each  name  is  a  single 
character,  possibly  subscripted,  while  in  its  I/O,  CGTPIF 
incorporates  subscripts  into  the  name  (e.g.,  A^  becomes 
"AT") .  Constraints  on  the  models  that  are  mentioned  below 
are  tested  by  CGTPIF  and  if  not  satisfied,  a  message  is 
written  to  the  user  terminal  and  execution  is  edborted. 


(B-la) 

(B-lb) 

(B-lc) 

(B-ld) 

(B-2a) 


B.3.1  Design  Model . 


x(t)  =  ^(t)  +  Bu(t)  +  E^n^(t)  +  Gw(t) 


=  A^n^(t)  +  G^^(t) 


y(t)  =  Cx(t)  +  DyU(t)  +  Eyn^(t) 


z(t.)  *  Hx(t.)  +  H  n,(t.)  +  v(t.) 
•z-  1  — z  1  — n-:^  1  ~  1 


and 


E{w(t)w^(t+T) }  =  Q6(t) 
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(B-2b) 


E{2J^(t)^{t+T)}  - 

E{v(t^)V^(tj)}  »  (B-2c) 

In  these  equations,  x,  u,  and  z  are  the  system 

state,  input,  disturbance  state,  output,  and  measurement 
vectors,  respectively.  In  input  pron^ts,  CGTPIF  refers 
to  the  diagonal  elements  of  the  noise  covariance  matrices 
as 

Q;  "state  noise  strengths"  (B-3a) 

Q  :  "disturbance  noise  strengths"  (B-3b) 

— n 

R:  "measurement  noise  strengths"  (B-3c) 

Note  that  g,  Q^,  and  R  are  all  assumed  to  be  diagonal 
matrices.  The  dimensions  of  the  model  are 

n  -  number  of  system  states 

r  =  number  of  system  inputs 

p  »  nunber  of  system  outputs 

m  s  number  of  state  measurements 

d  s  nuinber  of  disturbance  states 

w  »  number  of  independent  system  noises 

Wq  *  nunber  of  independent  disturbance  noises 

(B-4) 

and  the  dimensions  of  the  matrices  of  the  model  are 


A 


n-by-n 

B  ;  n-by-r 

n-by-d 

G  :  n-by-w 

g  :  w-by-w 

C  :  p-by-n 

Dyt  p-by-r 

E^s  p-by-d 

H  :  m-by-n 

H  :  m-by-d 

— n 

R  ;  m-by-m 

:  d-by-d 

— n 

G^:  d-by-Wjj 

fin* 

CGTPIP  requires  that  the  numbers  of  design  systems 
inputs  cuid  outputs  be  equal:  r^p.  Also,  the  number  of  sys¬ 
tem  states  may  not  be  less  than  the  number  of  disturbance 
states,  due  to  the  computational  setup  used  for  the  CGT 
solution  (see  Section  A. 7.1).  The  dimensions  n,  r,  and  p 
must  be  non-zero;  any  of  the  other  dimensions  may  be  zero. 
If  m  is  zero  or  if  w  and  are  both  zero,  the  Kalman 
filter  design  path  cannot  be  pursued.  Matrices  having 
either  dimension  zero,  do  not  exist  and  are  not  entered. 
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B.3.2  Truth  Model 


(B-6a) 

-  H^^(t.)  +  2^(t.) 

(B-6b) 

(t)  * 

(B-6c) 

nd"(t)  » 

(B-6d) 

E{w^(t)w^(t+T)}  =  Q^6(t) 

(B-7a) 

=  Vij 

(B-7b) 

Mote  that  and  are  both  assumed  to  be  diagonal 
matrices.  In  these  equations,  x^,  u^,  and  are  the  truth 
model  system  state,  input,  and  measurement  vectors,  respec¬ 
tively.  The  vectors  and  ^  are  as  defined  for  the 
design  model. 

The  dimensions  of  the  truth  model  are 

n^  =  number  of  system  states 

r^  =  number  of  system  inputs 

m,p  ^  number  of  system  measurements 

w_  =  number  of  independent  noises  driving  system 
dynamics 

(B-8) 

and  the  dimensions  of  the  matrices  of  the  model  are 
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n^-by-n^ 


-t‘ 

-t* 

fit*  w^-by-w^ 

-t*  “T“J=y"”T 

R^t  in^-by-n\j, 

Idt- 

-NT* 

CGTPIF  requires  that  the  numbers  of  inputs  and  of 
measurements  for  the  truth  and  design  model  be  the  same: 
r^=r  and  iiVj,=m.  If  the  number  of  driving  noises  (w^)  is 
zero,  evaluation  of  a  Kalman  filter  design  is  not  pursued 
(since  a  covariance  analysis  with  no  truth  model  driving 
noise  would  not  be  very  informative) .  Matrices  having 
either  dimension  zero,  do  not  exist  and  are  not  entered. 


B . 3 . 3  Command  Model . 


— m 


A  X  (t)  +  Bu„(t) 
— m— m  — m— m 


C_x  (t)  +  D  u  (t; 
-m-m  -m-^ 


(B-lOa) 

(B-lOb) 


In  these  equations,  x  ,  u  ,  cuid  y  are  the  command  model 

— m  —TO 

state,  input,  and  output  vectors,  respectively. 

The  dimensions  of  the  command  model  are 
n^  «  number  of  model  states 
r„  *  nvunber  of  model  inputs 

n 

Pj^  >  number  of  model  outputs  (B-11) 


98 


and  the  dimensions  of  the  matrices  are 


—01 

—III 

P„-by-n„ 

(B-12) 

CGTPIP  requires  that  the  number  of  outputs  of  the 

command  and  design  models  are  equal:  Pw=p.  Also,  the 

n 

nuitber  of  system  states  of  the  command  model  (n„)  cannot 

H 

be  greater  than  the  number  of  system  states  of  the  design 
model  (n) .  This  constraint  is  due  to  the  setup  for  confuta¬ 
tion  of  the  CGT  solution  (see  Section  A. 7.3) . 

B.4  File  Usage 

In  addition  to  the  input/output  (I/O)  communication 
directly  with  the  user  terminal,  CGTPIF  employs  four  disk 
files  for  I/O  purposes.  One  of  these  ('PLOT')  is  for 
temporary  use  by  CGTPIF  only.  The  other  three  files 
('SAVE',  'DATA',  and  'LIST')  benefit  the  user  by  providing 
continuity  between  distinct  executions  of  the  program 
(SAVE,  DATA)  or  provide  supplementary  design  output  data 
(LIST) . 


B.4.1  SAVE  and  DATA  Files.  CGTPIF  preserves 
information  for  use  in  distinct  executions  of  the  program 
through  use  of  the  SAVE  and  DATA  files.  During  program 
execution,  the  dynamics  models  as  well  as  the  PI  regulator 
gains  (if  available)  may  be  written  to  the  SAVE  file. 
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Following  execution,  the  user  may  wish  to  catalog  SAVE 
as  a  permanent  file.  In  subsequent  executions,  CGTPIF  may 
(at  the  user's  option)  read  any  of  the  dynamics  models  or 
PI  gains  from  the  file  neuned  DATA. 

Both  files  are  rewound  prior  to  and  following 
program  execution.  Letting  the  abbreviations  "BE"  and  "AE" 
mean  before  and  after  execution,  respectively,  typical 
operations  on  these  files  include: 

1.  Catalog  SAVE  file: 

a.  BE:REQUEST,SAVE,*PF 
AE : CATALOG , SAVE , p  f n 

b.  AE: REQUEST, DUM,*PP 
AE : COPYBF , SAVE , DUM 
AE : CATALOG , DUM , pf n 

2.  Attach  DATA  file: 

BE : ATTACH , DATA , pf n 

3.  Reuse  SAVE  file  as  new  DATA  file 

AE: RETURN, DATA 

BE: COPYBF, SAVE, DATA  (B-13) 

None  of  these  operations  are  required;  they  are  simply 
useful  operations  in  the  event  the  user  chooses  to  employ 
the  files  to  streamline  repeated  executions  of  a  given 
design  problem.  Note  that  SAVE  and  DATA  are  local  file 
names  euid  that  the  permanent  file  names  are  represented 
here  by  the  abbreviation  "pfn" .  Other  operations  (e.g., 
PURGE)  and  other  combinations  of  operations  are  possible 
as  for  any  files,  and  the  usual  rules  for  these  opera¬ 
tions  apply  here  as  well.  The  essential  points  to  under¬ 
stand  are  that  the  SAVE  file  is  created  by  CGTPIF  and  is  an 


output  file  only,  and  that  DATA  is  a  previously  SAVE'd 
file  under  a  new  local  file  name  and  is  an  input  file 
only.  During  a  single  program  execution  the  two  files  are 
distinct  and  these  roles  cannot  be  changed. 

B.4.2  LIST  File .  During  program  execution, 
extensive  design  information  is  output  to  the  LIST  file. 
After  execution  is  complete,  the  user  may  wish  to  route 
LIST  to  a  line  printer  for  listing  (or  it  may  be  "PAGED" 
at  the  user  terminal) .  The  file  is  rewound  before  and 
after  execution.  To  send  LIST  to  a  line  printer,  the 
following  command  is  used  after  execution: 

ROUTE , LIST , DC=PR , TID=nn , ST=CSB , FID=abc  (B-14 ) 

in  which  "nn"  is  the  identification  number  of  the  terminal 
to  which  the  file  is  to  be  sent  (for  AFIT,  nn=91) ,  and 
"abc"  is  any  three  character  output  banner  for  the  listing. 

B.4.3  PLOT  File.  The  PLOT  file  is  used  internally 
by  CGTPIF  for  temporary  storage  of  the  variables  generated 
by  time  response  evaluations  of  the  controller  or  filter. 

If  desired,  it  may  be  eliminated  following  execution  using 
the  command: 

RETURN, PLOT  (B-15) 
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B.5 


CGTPIF  Execution 

B.5.1  Overview.  An  important  feature  of  CGTPIF 
is  that  it  follows  appropriate  paths  through  execution 
automatically,  prompting  the  user  for  input  as  necessary. 
The  basic  design  paths  are  selected  by  the  user  under 
prompting,  but  within  a  given  path,  only  information  needed 
to  execute  the  specific  design  and  evaluation  is  requested 
by  the  program.  The  user  thus  does  not  need  any  predeter¬ 
mined  sequence  of  command  entries  to  the  program,  nor  are 
the  commands  coded  in  any  way. 

Figure  B-1  gives  a  general  flowchart  of  CGTPIF. 

The  first  direct  input  into  the  program  is  the  sample 
period  (in  seconds)  of  the  digital  controller.  Each  of  the 
decision  blocks  (diamond  shaped)  represent  a  prompted 
request  for  input  to  choose  the  design  to  be  pursued. 

Each  rectangular  block  with  an  alphabetic  character  ("A" 
through  "G")  in  the  lower  right  corner  represents  a  "con?>u- 
tational  element"  of  CGTPIF  and  is  discussed  individually. 

The  block  labeled  "Establish  Design  Model  [A]" 
is  a  specific  instance  of  the  usage  of  a  set  of  routines 
employed  in  establishing  all  three  of  the  dynamics  models. 
The  command  model  is  established  in  the  design  path  of  the 
CGT  controller.  The  truth  model  is  established  just  prior 
to  the  controller  or  filter  evaluation  blocks.  Although 
the  specific  I/O  messages  differ  in  content  for  each  model 
established  by  this  computational  element,  the  kinds  of 
I/O  are  the  same. 
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The  subsections  which  follow  discuss  the  I/O  of 
each  computational  element.  In  identifying  items  of 
I/O,  reference  will  sometimes  be  made  to  array  names  and 
equations  vAiich  are  specified  in  the  "Programmer's 
Guide"  (equation  references  will  be  in  parentheses  follow¬ 
ing  the  array  name) .  All  prompts  for  input  define  the  input 
that  is  being  requested  and  the  manner  in  which  the  entry 
should  be  given.  Since  the  actual  prompts  are  themselves 
understandable,  they  will  not  be  quoted  here.  Instead, 
flowcharts  will  be  used  to  show  where  pronqpts  occur  and  how 
execution  depends  on  user  entries.  Blocks  involving  I/O 
will  be  identified  by  function:  an  "I"  block  will  signify 
prompted  input  from  the  terminal;  an  "OT"  or  "OL"  block 
will  signify  output  to  the  user  terminal  or  LIST  file, 
respectively.  All  output  to  LIST  is  separated  and  iden¬ 
tified  according  to  the  computational  element  which 
generated  it. 

B.5.2  Types  of  Entries.  Required  inputs  may 
entail  entry  of  a  decision  logic  value,  a  single  numerical 
or  character  value,  or  multiple  numerical  values  for 
arrays  or  vectors.  In  all  cases,  CGTPIF  pronpts  the  user 
with  messages  identifying  the  nature  of  the  input  requested 
and  each  prompt  ends  with  the  character 

B. 5.2.1  Decision  Logi*^  .  All  requests  for  deci¬ 
sions  affecting  execution  are  freuned  as  questions  requiring 
a  YES  ("Y")  or  NO  ("N")  response.  The  user  entry  is  read 


as  character  input.  Execution  proceeds  according  to  a 
default  "YES"  assunption:  all  decision  tests  assume  that 
if  the  answer  is  not  "NO",  then  it  is  "YES”. 

B.5.2.2  Single  Entry .  Requests  requiring  single 
entry  responses  always  specify  the  variable  requested. 

If  there  are  constraints  on  acceptable  input  they  are 
indicated  in  the  pron^t  and  adherence  is  tested  in  the 
progreun  after  entry.  If  the  entry  is  not  "valid,"  a 
message  is  written  to  the  terminal  and  the  pron^t  is 
repeated . 


B.5.2.3  Multiple  Entry.  All  requests  for  entry 
of  vector  or  array  elements  specify  the  name  of  the  array 
in  question  and  its  actual  dimensions.  Entries  for  vector 
elements  include  an  integer  specifying  the  index  of  the 
element,  and  a  real  specifying  its  value.  For  most  arrays, 
all  elements  may  be  given  values,  while  for  some  square 
matrices,  only  diagonal  elements  may  be  set.  In  the  usual 
case,  elements  are  entered  into  arrays  by  specifying  two 
integers  for  the  [row, column]  address  and  a  real  for  the 
value  of  that  element.  In  cases  in  vdxich  only  diagonal 
elements  can  be  specified,  entry  is  the  scune  as  for  vectors, 
with  the  matrix  diagonal  considered  a  vector. 

As  many  entries  as  desired  may  be  made  and  any 
entry  can  be  repeated  (e.g.,  to  correct  previous  erroneous 
entries) .  Entry  is  terminated  by  specifying  a  row  index 
of  zero.  Each  entry  is  tested  to  verify  that  it  lies 
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within  the  [row, column]  bounds  of  the  array  (vector) .  If 
2m  index  is  not  "valid”,  a  message  is  written  to  the 
terminal  indicating  the  error  and  the  initiid  prompt  with 
the  array  dimensions  is  given  again  (previous  valid 
entries  are  not  affected,  only  the  specific  invalid  entry 
is  rejected) .  If  an  entry  is  valid,  the  element  value 
is  set  and  the  next  entry  is  awaited  without  additional 
prompting.  For  example,  if  it  is  desired  to  set  a  square 
matrix  of  dimension  three  to  an  identity  matrix,  then 
according  to  whether  the  specific  matrix  is  to  be  entered 
in  [row,  column]  or  diagonal  form,  entries  would  be  as 
follow: 

1.  For  [row, column]  entry  format 

111.  (enter) 

221.  (enter) 

331.  (enter) 

0/ 

2.  For  diagonal  element  entry  format 

1  1.  (enter) 

2  1.  (enter) 

3  1.  (enter) 

0/ 

Items  of  information  may  be  separated  by  one  or  more  blanks 
or  by  a  comma.  These  entries  set  sf>ecific  elements  of  the 
matrix  to  non-zero  values,  where  it  has  been  assumed  (as 
is  generally  the  case)  that  the  matrix  was  initialized 
automatically  with  all  elements  zeroed. 
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B.5.3  Establishing  Dynamic s  Models  ("A") .  All 
three  dynamics  models  (design,  truth,  and  command)  are 
entered  under  the  control  of  a  single  set  of  routines. 

The  options  for  entry  and  the  type  of  I/O  involved  for 
each  is  of  identical  format,  but  pronpts  and  output  employ 
terminology  specific  to  each  model  to  identify  items  of 
I/O. 

Figures  B-2a,b,c  give  flowcharts  of  the  I/O 
involved  in  entry  of  the  models.  Mote  that  emy  of  the 
dynamics  models  may  be  entered  in  any  of  the  following 
ways: 

1.  The  dimensions  and  array  elements  may  be  read 
from  the  DATA  file. 

2.  The  dimensions  and  array  elements  may  be 
entered  from  the  user  terminal  as  prompted  by  CGTPIF. 

3 .  The  dimensions  and  array  elements  may  be 
determined  by  user-provided  subroutines. 

These  modes  of  entry  are  offered  by  CGTPIF  in  the  order 
above  with  option  3  assumed  selected  if  options  1  and  2 
cure  declined.  If  option  1  is  selected,  the  reading  of  the 
model  is  automatically  performed.  If  the  model  is  found 
not  to  exist  in  the  DATA  file,  the  other  options  are 
offered.  For  option  3,  if  the  subroutines  needed  to  define 
the  model  are  not  loaded,  options  1  and  2  are  offered  again. 
This  logic  is  illustrated  in  Figure  B-2a. 

Prior  to  entry  of  the  model  matrices,  all  matrix 
elements  are  initialized  to  zero.  Using  option  1,  all 
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array  elements  are  then  read  automatically  from  the  DATA 
file.  For  options  2  and  3  only  the  non-zero  array  elements 
must  be  established. 

Figure  B-2b  illustrates  model  definition  under 
option  2.  Entry  of  the  dimensions  and  arrays  is  according 
to  prompts  by  CGTPIF.  The  dimensions  are  requested  first 
by  the  names  and  in  the  order  of  equation  (B-4) ,  (B-8) , 
or  (B-11) ,  as  appropriate.  The  arrays  are  then  requested, 
also  by  name  and  in  the  order  of  equation  (B-5) ,  (B-9) , 
or  (B-12) ,  as  appropriate.  An  array  is  not  requested  if 
its  dimension  is  zero.  Each  prompt  includes  the  actual 
dimensions  of  the  array  according  to  the  model  dimensions 
previously  entered.  Elements  of  arrays  are  entered  by 
address,  and  value  by  giving  the  [row,colvunn]  address  and 
element  value  as  a  three  item  input.  Entry  of  a  zero  row 
address  terminates  entry  of  the  array. 

For  option  3,  each  model  requires  two  user- 
provided  routines  of  prescribed  names,  argument  lists, 
emd  cheuracteristics.  These  must  be  compiled  with  the  main 
routine  of  CGTPIF  and  a  segmented  executable  object  file 
created.  The  "Programmer's  Guide"  describes  the  specific 
requirements  for  the  subroutines  and  the  necessary  pro¬ 
cedure  to  obtain  an  executable  CGTPIF  program.  The  job 
control  sequence  giving  a  segmented  object  file  is  shown 
in  Appendix  E. 

After  a  model  is  defined  using  any  of  the  three 
entry  options,  the  user  may  list  any  matrix  and  modify 
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any  array  elements,  again  under  prompting  by  CGTPIF.  If 
a  modification/list  is  desired,  the  names  of  the  model's 
matrices  are  listed  at  the  terminal  and  the  user  specifies 
the  array  of  interest  by  name.  Elements  are  entered  by 
address  and  value  as  described  previously.  Figure  B-2c 
illustrates  the  I/O  involved  in  modifying/listing  model 
arrays . 

When  the  model  has  been  defined  to  the  user's 
satisfaction,  it  may  be  written  to  the  SAVE  file  by  CGTPIF 
if  the  user  chooses.  In  the  course  of  design  iteration, 
the  truth  and  command  models  may  be  redefined  if  desired, 
but  only  a  single  copy  of  any  model  may  be  written  to  the 
SAVE  file  during  a  given  execution  of  the  program  (CGTPIF 
will  not  offer  additional  opportunities  after  a  given 
model  has  been  SAVE'd) . 

For  each  model,  the  discrete-time  representation 
is  computed  for  the  controller  sample  period  specified. 
Later  computations  do  not  depend  on  -the  continuous-time 
dyncunics  models,  so  the  arrays  defining  them  are  not 
retained. 

Arrays  defining  both  the  continuous -time  and 
discrete-time  models  are  given  in  output  to  the  LIST  file. 
The  specific  output  items,  their  names,  and  the  reference 
equations  are  listed  below  for  eadi  model  (note  that 
equations  (A-*)  are  from  Appendix  A) : 
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Design  Model 

Continuous-time  model  matrices  as  listed  in 


equation 

(B-5) 

discretized  model 

matrices  as: 

"PHI"; 

i 

(A-22a) 

"BD" ; 

5d 

(A-22b) 

"QD": 

^^d 

(A-21c) 

"HA"; 

Sa 

(A-24) 

"EXD"; 

E 

-*d 

(A-22a) 

"PHN"; 

— n 

(A-22a) 

Command  Model 

Continuous-time 

model  matrices  as 

listed  in 

equation 

(B-12) 

discretized  model 

matrices  as: 

"PHM"; 

$ 

— m 

(A-26a) 

"BDM" ; 

B 

■™d 

(A-26b) 

"CM" ; 

(B-12) 

"DM" : 

5m 

(B-12) 

Truth  Model 

Continuous-time 

model  matrices  as 

listed  in 

equation 

(B-9) 

discretized  model 

matrices  as: 

"PHT"; 

it 

(A-28a) 

"BDT"; 

St. 

(A-28b) 

"QDT": 

St. 

(A-28c) 

In  addition,  the  eigenvalues  of  the  system  matrices 
of  each  model  (A,  A^)  are  computed  and  output  both  to 

the  user  terminal  and  the  LIST  file.  The  system  model  is 


identified  by  type  (design,  conimand,  truth)  .  Eigenvalues 
of  the  corresponding  discretized  system  matrices  are  not 
computed . 


B.5.4  Controller  Setup  ("B") .  The  "controller 
setup"  routines  perform  computations  needed  for  the  con¬ 
troller  designs.  No  input  is  required  of  the  user  emd  the 
output  is  to  the  LIST  file  only.  The  output  is,  the 
matrix  II; 

"PI":  n  (A-29) 

B.5.5  PI  Design  ("C") .  Execution  of  the  PI 
design  path  entails  user  entry  of  quadratic  weighting 
matrices  defining  the  costs  associated  with  output  devia¬ 
tions,  control  magnitudes,  and  control  rates  (see 
Figure  B--; ; 

"OUTPUT  DEVIATIONS";  Y  (A-32a) 

"CONTROL  MAGNITUDES";  U^  (A-32b) 

"CONTROL  RATES";  U  (A-34) 

For  each  of  these  matrices,  only  the  diagonal  elements  are 
entered.  On  the  first  execution  of  the  PI  design,  all 
weighting  matrices  are  initialized  to  zero.  Subsequent 
iterations  preserve  the  elements  of  these  matrices  so 
only  desired  changes  in  specific  weighting  elements  need 
be  entered.  Weights  on  output  deviations  should  be 
non-negative,  vdiile  weights  on  control  magnitudes  and 
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Pig.  B-3.  PI  Regulator  Design 


rates  should  be  positive.  Entries  are  tested  for  positive 
or  non-negative  values  as  appropriate.  If  an  entry  is  not 
valid,  a  message  is  written  to  the  user  terminal  and  that 
entry  is  not  accepted. 

Matrices  Y  and  are  used  to  compute  a  q[uadratic 
weighting  matrix  on  the  state  deviations  (using  an  aug¬ 
mented  state  vector  composed  of  system  state  and  control 
magnitude  perturbations  from  nominal) .  This  new  matrix 
is  referred  to  as  "X"  (equations  (A-32)  and  (A-33)).  The 
user  may  then  modify  any  element  of  X  and/or  list  it  at 
the  terminal.  Elements  entered  into  X  are  automatically 
set  symmetrically  by  CGTPIF  but  the  sign  of  diagonal  ele¬ 
ments  entered  is  not  tested.  X  is  not  preserved  between 
PI  design  iterations,  so  any  desired  changes  in  elements 
with  respect  to  their  values  as  determined  from  Y  and 
must  be  re-entered  each  design  pass. 

The  diagonal  elements  of  Y,  U  ,  and  U  are  printed 

y  c 

at  the  user  terminal  and  the  entire  Y,  U  ,  U  ,  and  X 
matrices  are  output  to  the  LIST  file.  Next,  the  regulator 
gains  and  PI  gains  are  computed.  The  PI  gains  are  printed 
at  the  terminal  ("KX"  and  "KZ")  and  all  gains  are  output 
to  the  LIST  file. 

The  outputs  to  the  LIST  file  are. 


"Y"; 

Y 

(A-32a) 

"UM" : 

(A-32b) 

"X"; 

X 

(A-33) 

"UR"; 

He 

(A-34) 
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"REG/PI  GAIN  MATRIX— GCS";  G*  (A-46) 

"KX":  ^  (A-48a) 

"KZ":  K  (A-48b) 

****2 

Note  that  the  mnemonics  "UM"  and  "UR"  refer  to  input 
magnitude  and  rate  weighting  matrices,  respectively. 

When  execution  of  the  PI  design  computations  is 
conplete,  the  "controller  evaluation"  set  of  routines  is 
automatically  executed.  These  are  discussed  in  a  later 
subsection  as  a  separate  computational  element. 

B.5.6  CGT  Design  ("D") .  Execution  of  the  "CGT 
design"  path  requires  that  a  command  model  be  established. 
If  desired,  a  new  command  model  can  be  established  during 
any  iteration  of  the  design.  The  model  is  actually 
entered  using  the  routines  described  in  Section  B.5.3 
above  ("Establishing  Dynamics  Models"). 

If  PI  gains  already  exist  in  the  program  storage, 
then  a  closed-lqop  CGT/PI  design  is  effected  automatically. 
If  not,  the  user  may  elect  to  have  the  program  read  the  PI 
gains  from  the  DATA  file  and  design  a  closed-loop  CGT/PI 
controller.  However,  if  the  user  chooses  not  to  have  the 
gains  read  from  DATA  or  if  the  gains  are  found  not  to  exist 
on  the  DATA  file,  an  open-loop  CGT  design  is  effected 
automatically  (by  setting  PI  gains  to  zero) ,  but  only  if 
the  open-loop  system  is  stable.  For  either  open-or  closed- 
loop  CGT  design,  the  matrices  A^^  (equation  A- 51)  are  auto¬ 
matically  output  to  the  LIST  file . 
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Figure  B-4  illustrates  the  1/0,  logic,  and  confuta¬ 
tions  of  the  CGT  design  path.  Details  involved  in  entering 
the  conuneuid  model  are  given  in  Section  B.5.3  and  are  indi¬ 
cated  in  this  figure  by  a  block  titled  "Establish  Command 
Model".  Note  that  since  the  continuous-time  representation 
of  the  command  model  is  not  preserved,  "modification"  of 
the  comm2uid  model  actually  entails  complete  redefinition  of 
it.  In  case  the  commemd  model  exists  on  the  DATA  file  and 
only  specific  elements  are  to  be  changed,  this  cetn  be 
accomplished  readily  by  reading  the  model  from  DATA  and 
then  modifying  individual  arrays  (as  shown  in  Figure  B-2c) . 

In  establishing  the  command  model,  I/O  is  as 
described  in  Section  B.5.3.  Additional  output  to  the  LIST 
file  is. 


All": 

^11 

(A-51a) 

'A21": 

-21 

(A-51d) 

'A12": 

-12 

(A-51b) 

'A22" 

-22 

(A-51e) 

A13" 

-13 

(A-51c) 

A23": 

-23 

(A-51f) 

KXM": 

K 

—X 

m 

(A-53a) 

KXU": 

K 

-*u 

(A-53b) 

KXN"; 

K 

^n 

(A-53c) 

The  controller  gains  ("KXM",  "KXU",  "KXN")  are  also 

printed  directly  at  the  user  terminal.  Note  that  arrays 

—13,  —23'  —X  only  if  disturbance  states  are 

n 
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specifically  modeled  in  the  design  model  of  equations 
(B-la,b)). 

When  execution  of  the  CGT  design  computations  is 
complete,  the  "controller  evaluation"  set  of  routines  is 
automatically  executed.  These  are  discussed  in  the  next 
subsection. 


B.5.7  Controller  Evaluation  ("E") .  A  single  set 
of  routines  performs  the  controller  evaluation  for  both  the 
PI  and  CGT  designs.  For  the  PI  controller,  the  poles  of 
the  closed-loop  discrete-time  system  matrix  t^'juation 

(A-44))  are  computed  and  mapped  into  the  primary  strip  in 
the  continuous-time  domain  (the  s -plane  poles  are  not 
listed  in  output) .  These  mapped  closed-loop  poles  are 
printed  both  to  the  user  terminal  and  the  LIST  file.  The 
primary  evaluation  tool  for  both  controllers  is  a  time- 
response  simulation.  For  the  PI  regulator,  the  response 
is  taken  for  non-zero  initial  conditions  (IC's)  on  the 


states;  for  the  CGT  controller  the  response  is  given  for 
a  step  input  on  any  of  the  command  model's  inputs.  In 
either  case,  the  system  dynamics  can  be  propagated  using 
the  design  model  or  truth  model  state  transition  equations. 
Time  response  runs  may  be  run  repeatedly  for  a  specific 
controller  desxjn. 

The  I/O,  logic,  and  computations  involved  in  the 
controller  evaluation  are  shown  in  Figure  B-5.  Decision 
blocks  labeled  "CGT"  test  for  the  type  of  controller  being 
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evaluated  (CGT  or  PI)  .  Decision  blocks  ledseled  "LTEVAL” 
test  if  the  truth  model  is  being  used  to  propagate  system 
^namics  (if  not,  the  design  model  is  being  used)  . 

The  first  pron^t  of  the  controller  evaluation  com¬ 
putational  element  asks  if  the  evaluation  is  to  be  con¬ 
ducted  with  respect  to  (WRT)  truth  model  dynamics.  If 
yes,  the  truth  model  may  be  established  or  modified  (if 
previously  established)  in  the  manner  described  in  Section 
B.5.3  above.  Note  that,  since  the  continuous-time  repre¬ 
sentation  of  the  truth  model  is  not  preserved  within 
CGTPIF,  "modification"  actually  entails  complete  redefini¬ 
tion  of  the  model .  In  the  case  that  the  truth  model  exists 
on  the  data  file  and  only  specific  array  elements  are  to  be 
modified,  it  is  convenient  simply  to  read  the  truth  model 
from  the  DATA  file  and  modify  matrix  elements  as  shown 
in  Figure  B-2c.  If  the  truth  model  had  been  established 
previously  and  no  modification  to  it  is  desired,  the 
existing  discrete-time  representation  of  the  truth  model 
is  used.  The  design  model  is  used  to  propagate  system 
dynamics  if  the  truth  model  evaluation  is  not  selected. 

For  the  CGT  evaluation,  the  first  input  prompt 
is  for  the  index  of  the  command  input  vector  to  vdiich  a 
step  input  is  to  be  applied,  and  the  magnitude  of  that 
step  (only  one  command  input  is  allowed  at  a  time) . 

CGTPIF  tests  the  input  index  for  validity  (within  vector 
length  bounds) ;  if  it  is  invalid  the  prompt  is  repeated. 

If  the  index  is  zero  (or  negative)  the  input  is  not 


accepted  and  the  user  is  queried  as  to  whether  time- 
response  runs  are  desired.  If  no  time-responses  are  to  be 
run,  the  controller  evaluation  routines  are  exited;  other¬ 
wise,  the  pron^t  requesting  command  model  input  specifica¬ 
tion  is  repeated.  If  the  CGT  controller  response  is  to  be 
run,  initial  conditions  on  the  system  states  may  be 
entered.  If  the  design  model  is  used  for  evaluation  and 
disturbance  states  exist  in  the  model,  they  may  be  given 
initial  conditions  also. 

For  the  PI  evcil nation  the  first  input  prompt  is 
for  IC's  for  the  system  states.  The  states  that  are 
actually  given  initial  values  are  those  of  the  design  or 
truth  model ,  according  to  the  model  used  for  propagation 
of  dynamics. 

Initial  conditions  are  entered  for  either  con¬ 
troller  in  the  same  manner.  Entry  is  of  the  index  of  the 
state  within  its  appropriate  state  vector  (design  or  truth 
model,  or  disturbance  state  vectors)  and  its  initial 
value.  Tests  and  termination  of  entry  are  as  described 
in  Section  B.5.2  for  multiple  entries. 

Time-response  plots  are  of  the  "line  printer" 
type  and  are  output  both  to  the  terminal  and  to  the  LIST 
file.  As  many  as  two  plots,  each  with  as  many  as  five 
dependent  variables,  may  be  printed  at  the  user  terminal. 
CGTPIF  prompts  the  user  to  specify  the  number  of  variables 
for  each  of  the  two  plots  (the  user  is  to  enter  two 
integers) .  If  the  user  enters  non-positive  integers  for 
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both  plots,  then  a  pron^t  queries  the  user  as  to  whether 
time -response  runs  are  desired.  If  no  time -responses  are 
to  be  run,  the  routines  are  exited.  Note  that  when  no 
plots  are  selected  for  terminal  printing,  none  are  output 
to  LIST  either  and  no  time -responses  are  simulated. 

In  the  case  that  plots  are  to  be  printed  at  the 
terminal,  a  series  of  prompts  allow  the  user  to  specify 
exactly  which  variables  shall  be  included.  Variables  are 
selected  by  specifying  a  name  of  the  vector  type  for  that 
variable  euid  its  index  in  two  entries  for  each  variable. 
The  names  of  the  vectors  are: 


"X": 

system  state 

vector 

"Y"; 

system  output 

vector 

"U"; 

system  input 

vector 

"D": 

disturbance  state  vector 

"M" : 

command  model 

output  vector 

The  system  state  vector  is  that  of  the  design  or  truth 
models,  according  to  the  model  used  for  propagation  of 
dynamics.  For  example,  the  pair  of  entries  "U"  and  "1" 
specifies  that  element  1  of  the  input  vector  U  is  to  be 
plotted  (note  that  "entry"  includes  a  carriage  return) . 

The  input  prompt  includes  these  definitions  and  includes 
only  those  variables  relevant  to  the  controller  being 
evaluated.  The  model  output  and  disturbance  state  vectors 
sure  only  offered  for  CGT  evaluations,  and  for  the  latter 
also  only  if  the  disturbance  states  are  explicitly  modeled 
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and  the  design  model  propagates  dynamics  of  the  time- 
response  (since  for  the  truth  model  the  system  state 
vector  includes  all  disturbance  states  which  are  con¬ 
sidered  to  act  on  the  system)  .  Each  user  entry  is  tested 
for  valid  (and  relevant)  name  and  for  valid  index.  Prompts 
specify  the  plot  nunber  and  output  number  for  each 
requested  entry. 

The  user  next  is  pronpted  to  enter  the  time  dura¬ 
tion  for  the  simulation.  However,  the  duration  actually 
simulated  may  be  adjusted  by  the  program:  a  time  span  that 
is  the  nearest  integer  multiple  of  100  times  the  controller 
scunple  period  is  selected.  Plots  to  the  LIST  file  include 
the  entire  time  span  and  use  100  equal  time  interval  scunples 
Plots  to  the  terminal  include  50  time  Scimples  selected  as 
follows:  if  the  time  duration  specified  by  the  user  is  less 
than  50  times  the  controller  sample  period,  the  samples 
plotted  are  the  first  50  time  samples  from  the  simulation; 
otherwise  the  entire  time  span  is  included  in  50  equal- 
interval  samples.  Thus,  for  example,  with  a  controller 
sample  period  of  .02  seconds  a  user  specified  time  dura¬ 
tion  of  less  than  1.  second  would  yield  plots  to  the 
terminal  running  from  timesO.  to  time^^l.  and  with  .02 
seconds  between  each  sample;  plots  to  the  line  printer 
would  include  samples  at  the  same  interval  but  extending 
to  time=‘2. 

After  completing  the  time-response  simulation,  a 
prompt  requests  a  title  for  the  plots  and  prescribes  the 
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field  width  available  for  the  entry  (50  characters) .  The 
title  is  applied  to  all  plots  generated  from  the  single 
simulation. 

Plots  are  printed  with  the  independent  (time) 
axis  running  vertically  along  the  length  of  the  output 
page  with  the  origin  at  the  top.  Each  seunple  time  is  iden¬ 
tified  along  the  left  margin  of  the  plot.  The  dependent 
axis  is  horizontal .  Each  variable  is  itmrked  with  an 
integer  from  1  to  5  at  each  sample  time.  Note  that  since 
only  one  character  can  be  printed  in  each  location  of  the 
plot  field,  when  two  or  more  variables  would  occupy  bl 
single  print  position  at  a  sample  time,  only  the  symbol 
of  largest  value  (1  to  5)  is  printed.  For  plots  to  the 
terminal,  if  a  model  output  is  among  the  variables  of  a 
plot,  then  all  variables  in  the  plot  are  plotted  over  a 
single  scale  range  to  facilitate  comparisons  of  actual 
2md  desired  output  responses.  In  all  other  cases  every 
variable  plotted  is  scaled  over  its  own  range  independently 
in  order  to  achieve  greater  resolution  for  each  in  the  plot 
field.  The  scale (s)  are  listed  along  the  bottom  of  the  plot. 
Rotation  of  the  output  page  through  90®  in  a  counter¬ 
clockwise  sense  gives  the  usual  abscissa-ordinate  orienta¬ 
tion.  Terminal  plots  are  50  print  positions  wide;  plots 
to  LIST  are  100  print  positions  wide. 

Plots  of  all  relevant  variables  in  a  time-response 
simulation  (all  states,  inputs,  and  so  on)  are  auto¬ 
matically  output  to  the  LIST  file  if  terminal  plots  are 
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requested.  Five  variables  are  included  in  each  plot.  A 
list  identifying  all  the  variables  by  type  and  index  for 
each  plot  nunber  and  plot  symbol  is  written  to  LIST  prior 
to  the  plots. 

When  all  plots  have  been  printed,  a  prosit  queries 
the  user  as  to  whether  additional  time-response  runs  are 
desired.  If  more  are  wished,  the  entire  set  of  plotting 
options  is  repeated  2md  the  same  controller  may  be  evalu¬ 
ated  under  different  conditions  and/or  different  variables 
may  be  plotted.  If  no  additional  simulations  are  wished, 
the  controller  evaluation  routines  are  exited. 

B.5.8  Kalmem  Filter  Design  ( "F") .  The  Kalman 
filter  design  routines  compute  the  steady-state  Kalman 
filter  gains  for  the  design  model .  Figure  B-6  shows  the 
I/O,  logic,  and  computations  involved.  Note  that  the  first 
execution  of  the  filter  design  path  bases  its  filter  com¬ 
putations  on  the  noise  strengths  specified  upon  initial 
entry  of  the  design  model.  In  subsequent  executions,  any 
of  the  noise  strengths  may  be  modified.  The  noise  strengths 
are  entered  as  vectors  of  the  matrix  diagonals  (only 
diagonal  elements  may  be  modified) .  The  matrices  are, 

"STATE  NOISE  STRENGTHS":  Q  (B-2a) 

"DISTURBANCE  NOISE  STRIWGTHS";  (B-2b) 

"MEASUREMENT  NOISE  STRENGTHS":  R  (B-2c) 


127 


Pronqpts  for  state  or  distiurbance  noise  strengths  are  given 
only  if  the  design  model  specifies  driving  noises  for  the 
respective  process  dynamics.  Negative  noise  strengths  are 
not  accepted. 

In  each  execution  of  the  filter  design  path,  the 
entire  noise  strength  matrices  and  Kalman  filter  gain 
matrix  are  output  to  the  terminal  and  LIST  file.  However, 
only  the  diagonal  elements  of  the  noise  strength  matrices 
are  printed  at  the  terminal. 

Following  computation  of  the  filter  gains,  the 
Kalman  filter  design  routines  are  exited.  Execution  pro¬ 
ceeds  automatically  to  the  filter  evaluation  computational 
element  described  in  the  next  subsection. 

B.5.9  Filter  Evaluation  ( ”G”) .  Figure  B-7  shows 
the  I/O,  logic,  and  computations  of  the  filter  evaluation 
routines.  Execvjtion  of  the  filter  evaluation  requires  that 
the  system  truth  model  be  established,  since  the  covari¬ 
ance  analysis  is  performed  with  respect  to  the  truth  model. 
Comments  in  Section  B.5.7  dealing  with  establishing  the 
truth  model  apply  equally  in  this  set  of  routines,  except 
that  here  use  of  the  truth  model  is  not  optional. 

Evaluation  begins  with  computation  of  the  eigen- 
vcd.ues  of  the  system-filter  matrix  (equation  (A-61)  )  . 

As  for  the  closed-loop  PI  regulated  system,  the  discrete¬ 
time  eigenvalues  are  mapped  to  the  primary  strip  in  the 
continuous-time  domain.  These  mapped  poles  are  printed 
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at  the  user  terminal  and  output  to  the  LIST  file  (the 
z-plane  eigenvalues  are  not  printed) . 

The  primary  evaluation  tool  applied  to  the  filter 
design  is  a  steady-state  covariance  analysis.  The  covari¬ 
ance  matrix  of  the  estimation  errors  of  the  filter  using 
measurements  of  the  truth  model  dynamics  is  propagated  for 
50  filter  (controller)  sample  periods.  Samples  are 
coincident  with  the  filter’s  Scunple  times  and  the  total 
nuni>er  is  fixed  at  50.  At  each  time  sample  the  standard 
deviations  of  these  "true"  errors  are  computed  as  the 
square-roots  of  the  diagonal  elements  of  the  error  covari¬ 
ance  matrix  (equation  A-72) .  The  filter's  own  computed 
error  covariance  matrix  is  P  of  equation  (A- 58) ,  which 

oi 

because  of  the  steady-state  assumption,  is  constant  for  all 
time  samples.  Taking  the  square-roots  of  the  diagonal 
elements  of  P  then  gives  the  filter's  estimate  of  the 
standard  deviations  of  its  errors  in  state  estimation. 

Plots  for  each  state  are  output  to  the  LIST  file  showing 
the  "true"  and  "computed"  RMS  errors  for  the  50  time 
samples.  A  title  may  be  entered  to  be  applied  to  all 
plots  from  the  covariance  analysis.  In  addition,  the 
"true"  euid  "computed"  RMS  errors  at  the  final  time  Seunple 
are  printed  at  the  terminal. 

This  completes  the  filter  evaluation.  A  new 
filter  design  may  then  be  pursued,  or  any  other  design 
option  may  be  selected. 
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B.6 


Program  Messages 

A  variety  of  messages  may  be  printed  at  the 
terminal  and/or  output  to  the  LIST  file  during  program 
execution.  Some  are  purely  informational,  are  clear  in 
their  meaning,  and  provide  no  essential  insight  into 
progress  of  the  design  or  possible  difficulties  in  program 
execution.  Such  messages  are  not  discussed  here.  The 
remaining  messages  relate  to  errors  or  potential  design 
difficulties  emd  are  considered  in  categories  of  memory 
allocation,  dimensional  errors,  or  computational  problems. 

B.6.1  Memory  Allocation.  CGTPIF  uses  vectors  in 
named  Commons  for  array  storage.  These  vectors  are  dimen¬ 
sioned  in  the  main  routine  and  a  variable  in  the  Common  is 
set  to  the  value  allocated.  These  vectors  are  then  par¬ 
titioned  within  CGTPIF  to  store  individual  arrays.  Before 
storing  arrays  into  each  vector  in  Common,  the  storage 
needed  is  computed  according  to  the  appropriate  equation 
listed  in  equatior.s  (A-15a)  through  (A-15j)  .  In  the  case 
of  temporary  storage  vectors,  at  each  point  in  execution 
at  which  a  new  allocation  is  needed,  the  particular  equa¬ 
tion  defining  that  need  is  used.  If  more  memory  will  be 
needed  in  a  vector  than  has  been  allocated,  a  message  is 
written  specifying  the  name  of  the  Common  and  the  neces¬ 
sary  minimum  allocation.  A  typical  message  of  this  type  is, 

"INSUFFICIENT  MEMORY  /SYSMTX/ ,  NEED:  nnnn" 
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in  which  the  Common  /SYSMTX/  has  too  little  storage  for  the 
problem  and  'nnnn'  is  the  dimension  required  for  the  vec¬ 
tor  in  that  Common.  For  the  vectors  containing  the 
dynamics  models,  the  model  with  insufficient  memory  is 
identified  by  name.  The  Commons  for  the  design,  truth, 
and  command  models  are  /DSNMTX/,  /TRUMTX/,  and  /CMDMTX/, 
respectively.  After  printing  such  a  message  to  the  user 
terminal,  execution  is  ed^orted. 

In  its  existing  form,  CGTPIF  will  have  sufficient 
vector  allocations  to  deal  successfully  with  problems  of 
many  different  combinations  of  dimensions  and  with  system 
matrices  in  the  range  of  10  to  20  states.  Since  the  pro¬ 
gram  will  not  allow  allocated  memory  to  be  exceeded,  it  is 
reasonable  to  attempt  any  given  problem  and  let  the  pro¬ 
gram  either  deal  with  it  successfully,  or  let  it  write  the 
appropriate  memory  message  if  the  problem  cannot  be  accom¬ 
modated.  Section  A. 9  of  the  "Programmer's  Manual"  dis¬ 
cusses  the  steps  necessairy  to  obtain  a  new  CGTPIF  with 
different  memory  allocations. 

B.6.2  Dimensional  Errors.  As  each  of  the  dynoimics 
models  is  established,  or  just  prior  to  computations  tdiich 
assume  relations  among  the  design  and  command  system  and 
disturbcuice  state  dimensions  (CGT  computations) ,  the  dimen¬ 
sional  constraints  mentioned  in  Section  B.3  are  tested. 

In  terms  of  the  dimension  notation  of  equations  (B-4) , 

(B-8) ,  and  (B-11)  the  constraints  are 


Design  Model:  p«r  and  n^d 

Truth  Model:  and  iQ^«in 

Command  Model:  P^”‘P  ^M  (B-16) 

If  such  a  constraint  is  not  satisfied,  a  message  is  written 
to  the  user  terminal  identifying  the  problem  and  execution 
is  aUsorted.  When  the  constraint  affects  only  a  specific 
section  of  code,  or  if  redefinition  of  the  model  (command 
or  truth)  can  resolve  the  error,  then  only  the  affected 
execution  path  is  ad)orted.  In  other  cases,  execution  is 
aborted  completely. 

Other  dimensional  tests  are  made  in  the  Kalman 
filter  design  and  evaluation  computational  elements.  For 
filter  design,  it  is  necessary  that  the  system  state  and 
disturbance  state  driving  noise  dimensions  not  both  be 
equal  to  zero,  and  that  the  number  of  measurements  be 
non-zero.  These  are  constraints  on  the  design  model: 

w  >  0 
or 

Wd>  0 

and 

m>0  {B-17) 

For  filter  evaluation,  the  number  of  driving  noises  for 
the  truth  model  must  be  non-zero: 

Wj>0  (B-18) 
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since  in  this  case,  the  system  is  deterministic  and  the 
covariance  analysis  %»uld  not  provide  much  useful  informa¬ 
tion  for  evaluation  of  the  filter's  perform2mce.  If  any 
of  these  constraints  are  not  satisfied,  a  message  is 
written  to  the  user  terminal  identifying  the  problem  and 
execution  of  the  filter  design-evaluation  computational 
elements  is  aborted. 

B.6.3  Computational  Problems.  In  certain  of  the 
computations,  characteristics  of  the  particular  design 
problem  may  be  identified  as  having  potential  impact  on  the 
attainment  of  design  objectives.  Messages  identifying 
these  characteristics  may  be  considered  informational. 

Other  messages  describe  computational  problems  that  are 
immediately  fatal. 

In  computing  the  n  matrix  of  equation  (A-29) ,  a 
pair  of  messages  may  be  generated  to  the  LIST  file: 

"PI  MATRIX  IS  RANK  DEFECTIVE" 


and 

"nr  X  nc  MT  RANK  mr" 

in  which  "nr"  and  "nc"  are  the  row  and  column 
dimensions  of  n  and  "mr"  is  its  rank.  The  first  message 
is  also  printed  at  the  user  terminal.  The  equations 
employing  n  assume  it  to  be  an  ordinary  matrix  inverse. 
If  it  is  rank  defective,  the  matrix  pseudo-inverse  is 
computed  instead.  Execution  of  the  progreun  continues 
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since  the  discussion  of  Reference  32  concerning  the  n 
matrix  suggests  that  useful  results  may  still  be  obtained 
through  use  of  the  pseudo-inverse . 

Solution  of  the  Riccati  equations  for  the  PI 
regulator  (equation  (A-43) )  and  the  Kalman  filter  (equa¬ 
tion  (A-58) )  is  achieved  using  an  iterative  algorithm 
(Ref  24)  vdiich  may  generate  messages  of  information  or 
fatal  error.  The  informative  message  for  the  PI  is, 

"RICCATI  SOLN  IS  PSD— RANK  nu:" 

in  which  "PSD"  means  positive  semi-definite.  For  the 
Kalman  filter  the  corresponding  message  is, 

"OBSERVABILITY  MATRIX  IS  nr  X  nc  OF  RANK  mr" 

in  which  "nr",  "nc",  and  "mr"  are  the  row,  column  dimen¬ 
sions  and  the  rank,  respectively.  These  messages  convey 
the  same  information  concerning  system  observability.  The 
message  is  written  in  the  case  of  the  PI  Riccati  equation 
only  if  the  solution  is  positive  semi-definite  (rcuik 
defective) .  Both  messages  are  output  to  the  LIST  file 
only. 

For  both  the  PI  and  filter  Riccati  equations  fatal 
error  messages  are  identical: 

"RICCATI  NON-CONVERGENT  IN  nn  ITERATIONS" 
or 

"RICCATI  BLOW  UP  AT  ITERATION  nn  INITIAL  N  *  mm" 
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in  which  "nn"  is  the  iteration  counter  at  the  occurrence 
of  the  error  and  "mm"  is  the  value  of  a  variable  set 
internally  and  used  in  achieving  initialization  of  the 
iterative  sequence  (the  internal  vzuriable  is  not  available 
for  modification  by  the  user) .  The  first  message  indi¬ 
cates  that  the  sequence  of  iterates  did  not  converge.  The 
second  message  may  indicate  numerical  difficulties  or 
uncontrollability  (un observability)  of  the  system  of  the 
PI  (filter)  equations.  Both  messages  are  output  to  the 
LIST  file  only;  a  system  error  exit  routine  is  then  called 
which  writes  "EXIT"  to  the  user  terminal  and  aborts  program 
execution.  Note  that  in  the  event  of  such  an  abort,  the 
local  files  SAVE,  DATA,  and  LIST  are  not  rewound  auto¬ 
matically. 

In  computing  the  CGT  controller  gains  an  error  may 
occur  in  solving  for  the  matrix  partitions  Aj^j^  or  A^^ 

(see  Section  A. 11. 5  of  the  "Programmer's  Guide").  If  the 
iterative  refinements  to  these  solutions  do  not  converge 
to  within  the  established  tolerance  (l.E-6),  then  the  fol¬ 
lowing  message  is  written  both  to  the  terminal  and  the  LIST 
file; 

"SOLUTION  ERROR  FOR  'A'  (CGT)  AFTER  3  ITERATIONS  =  nnn" 

in  vdiich  "nnn"  is  the  Euclidean  norm  of  the  refining 
matrix  solution  (residual)  at  the  last  iteration.  The 
message  is  considered  to  be  informational,  and  execution 
proceeds  normally.  However,  in  case  the  value 
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of  the  residual  norm  is  large  con^ared  to  the  convergence 
toleremce,  the  CGT  design  solution  cem  be  expected  to  be 
inval id . 


B.7  Running  CGTPIF 

This  "User's  Guide"  assumes  that  a  segmented  exe¬ 
cutable  object  file  of  CGTPIF  exists.  If  it  does  not, 
refer  to  the  "Progreunmer ' s  Guide”  for  instructions  for 
obtaining  such  a  file. 

For  an  existing  CGTPIF  object  file  the  following 
commands  must  be  entered  in  INTERCOM  to  run  the  program: 

CONNECT , INPUT , OUTPUT 
ATTACH , CGTPIF, pfn 
CGTPIF 

I 

in  which  *pfn'  is  the  permanent  file  on  which  the  object 
file  is  cataloged.  CGTPIF  will  then  execute  as  descr jibed 
in  Section  B.5.  Additional  commands  before  and  after 
execution  may  be  appropriate  according  to  one's  intended 
use  of  the  various  local  files  which  CGTPIF  employs  during 
execution.  Refer  to  Section  B.4  for  suggested  commeinds 
relevant  to  file  usage. 


1 


138 


Appendix  C 

CGTPIF  Input /Output  Listing 


The  input/output  (I/O)  listing  given  here  is  from 
a  single  execution  of  CGTPIF.  It  shows  two  PI  regulator 
designs,  a  CGT/PI  design,  and  a  Kalman  filter  design  for 
design  model  AFTI (S3 ,A2,G3) .  The  regulators  emd  controller, 
as  well  as  the  filter  covariance  analysis,  are  all  evalu¬ 
ated  with  respect  to  the  truth  model  AFTI (S4 ,A2,G3) .  The 
controller  design  is  for  the  pitch-pointing  decoupled 
control  law.  Details  concerning  the  design,  truth,  and 
command  models  employed,  as  well  as  information  about  the 
results  of  these  designs,  are  given  in  Chapter  VI  of  this 
study . 

The  I/O  shown  is  that  obtained  directly  at  the 
user  terminal  during  execution.  The  listing  is  complete 
and  in  order,  but  it  has  been  divided  into  individual 
page-sized  portions  for  presentation.  During  execution, 
additional  extensive  output  was  placed  on  the  'LIST'  file. 
The  LIST  file's  output  is  not  reproduced  here.  It  extends 
as  continuous  listing  over  about  4  5  pages  emd  uses  eui  out¬ 
put  field  width  of  125  character  positions.  However, 
Section  C.2  gives  a  brief  description  of  the  output  appear¬ 
ing  on  LIST  for  this  single  execution.  Refer  to  the 


"Programmer's  Guide"  and  the  "User’s  Guide"  for  descrip¬ 
tions  of  the  terminology  used  to  refer  to  the  various 
items  of  I/O  given  here. 


C.l  CGTPIF  Terminal  I/O  Listing 

C.1.1  Introduction.  For  this  design,  both  the 
design  model  and  the  truth  model  are  obtained  from  a  'DATA' 
file.  The  command  model  is  of  low  dimension  and  is  entered 
directly . 

In  the  listing  below,  all  user  entries  are  iden¬ 
tified  with  an  arrow  symbol  to  the  immediate  right  of  each 
entry.  Prior  to  and  following  program  execution,  INTERCOM 
prompts  for  input  are  given  by  "COMMAND-" .  Within  program 
execution  entries  occur  in  two  ways:  (1)  when  the  entry 
is  on  the  seune  line  as  an  input  prompt,  the  entry  is 
bounded  on  the  left  by  the  symbol  (2)  in  case  of 

multiple  entries  for  a  single  prompt,  entries  after  the 
first  include  the  entire  line  that  is  identified. 

Portions  of  I/O  are  discussed  within  individual 
numbered  paragraphs.  Each  portion  of  listing  begins  on  a 
new  page.  The  specific  portions  of  listing  are  identified 
by  a  number  in  parentheses  at  the  top  center  of  the  page 
vdiere  it  begins,  and  these  numbers  correspond  to  the  para¬ 
graph  niunbers  below. 

C.l. 2  Summary  of  Input/Output . 

(1)  Following  "LOGIN",  the  executable  object  file 
'CGTPIF'  is  attached,  as  well  as  the  'DATA'  file  containing 
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the  design  and  truth  models.  Note  that  'CGTPIF*  and  'DATA' 
are  local  file  names  vdiile  'THESIS'  and  'DESIGN'  are  the 
corresponding  pernument  file  names.  Next,  permanent  file 
space  is  requested  for  the  loced.  file  name  'SAVE';  the  SAVE 
file  will  be  generated  during  subsequent  execution  of  the 
program.  The  "CONNECT"  command  defines  the  user  terminal 
as  the  device  that  communicates  through  the  FORTHAN 
standard  'INPUT'  and  'OUTPUT'  files.  Progreun  execution 
is  initiated  with  the  simple  command  "CGTPIF",  vdiich  loads 
the  local  file  CGTPIF  and  begins  execution  at  its  starting 
address. 

(2)  Program  execution  begins  with  output  of  an 
identifying  header  which  includes  the  current  date  and 
time  (obtained  from  calls  to  system  real-time  clock 
routines) .  The  first  user  entry  is  the  sample  period  of 
the  controller.  Next,  the  design  model  is  established. 

The  design  model  is  read  from  the  local  file  DATA.  As 
described  in  Chapter  VI  of  this  thesis,  two  different  con¬ 
trollers  were  designed  for  this  aircraft  dynamics  model  and 
for  each  there  were  different  definitions  of  the  output 
matrix  C  of  the  design  model.  Thus,  the  C  matrix  is  listed 
in  order  to  verify  that  the  data  corresponds  to  the  pitch¬ 
pointing  design  case.  Since  the  C  matrix  is  correct,  no 
changes  axe  made  to  its  elements  (immediate  entry  of 
"0/"  vdien  requested  to  enter  element  address  and  value) . 

The  design  model  is  then  written  to  the  SAVE  file.  The 
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poles  (eigenvalues)  of  the  design  model  (A  matrix)  are 
automaticcLLly  confuted  and  printed. 

(3)  The  controller  design  path  is  then  pursued, 
and  a  PI  regulator  design  is  chosen.  Quadratic  weights  of 
200.  on  outputs  1  £md  2,  and  of  1.  on  input  magnitudes  and 
rates  are  entered.  Weights  of  the  X  matrix  (augmented 
state  and  input  magnitude  weighting  matrix)  are  not  modi¬ 
fied.  The  PI  gains  and  are  computed  and  printed. 

(4)  The  evaluation  of  the  PI  regulator  is  chosen 
to  be  with  respect  to  the  truth  model  dynamics.  The  truth 
model  is  read  from  the  DATA  file,  is  not  modified,  cuid  is 
written  to  the  SAVE  file.  The  poles  of  the  truth  model 
(A^  matrix)  are  automatically  computed  and  printed. 

(5)  Evaluation  of  the  PI  regulator  begins  with 

computation  and  printout  of  the  continuous- time  mapped 
poles  of  the  closed-loop  system  matrix  •  In  prepara¬ 

tion  for  a  time-response  simulation  of  the  closed-loop 
system,  initial  conditions  of  0.01  and  -0.01  for  states  1 
amd  2  of  the  truth  model  are  entered.  One  plot  of  2 
variables  is  printed  at  the  terminal.  The  variables  are 
selected  as  outputs  1  and  2  (^(1)  and  ^(2)).  A  time  dura¬ 
tion  of  0.9  seconds  is  selected,  which  will  give  a  plot 
including  all  of  the  first  50  controller  sample  times  and 
will  run  for  a  duration  of  1.  second  at  the  terminal  (here 
T-0.02,  and  50*T=1.).  An  identifying  title  is  specified 
for  the  plot.  In  the  resulting  plot  the  time-aucis  is 
vertical,  the  dependent  axis  is  horizontal,  and  plot 
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I 


symbols  1  emd  2  identify  the  plotted  variables  in  order 
as  specified  above.  Note  that  a  rotation  of  the  plot 
through  90°  in  the  counter  clock-wise  sense  gives  the  usual 
abscissa-ordinate  orientation.  Both  plot  varicdsles  are 
scaled  individually  over  ranges  of  (-0.0090  to  0.0110)  and 
(-0.0050  to  0.0200),  respectively. 

(6)  No  additional  time -responses  are  wished,  cuid 
the  design  of  the  PI  regulator  is  repeated.  In  this  itera¬ 
tion,  the  quadratic  weights  are  not  modified  (weights  on 
outputs,  input  magnitudes,  and  input  rates  are  preserved 
throughout  program  execution,  unless  specifically  modified) . 
However,  the  X  weighting  matrix  is  modified  to  include  a 
weight  of  50.  on  state  3  of  the  design  model  (weight  is 
value  of  element  X(3,3)).  Note  that  the  X  matrix  is  com¬ 
puted  anew  each  iteration  from  the  weighting  matrices  on 
the  outputs  and  the  input  magnitudes.  Thus,  modifications 
made  explicitly  to  X  are  not  preserved  between  design 
iterations.  The  PI  gains  K  and  K  are  computed  and 

"“X  ““Z 

printed. 

(7)  Evaluation  of  the  PI  regulator  is  again  taken 
with  respect  to  the  truth  model,  which  is  left  as  it  had 
been  previously  defined.  The  evaluation  proceeds  in  the 
same  way  as  described  in  Paragraph  (5)  above.  Note  the 
improved  damping  in  the  responses  of  both  outputs. 

(8)  No  additional  time -responses  are  selected. 
Having  achieved  a  satisfactory  PI  design,  a  CGT/PI  design 
is  pursued  next.  The  command  model  is  entered  directly 
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from  the  terminal.  It  is  defined  as  a  2  state,  2  input,  and 

2  output  model.  The  matrix  ^  is  diagonal  with  values  of 

-5.  for  both  entries;  the  matrix  B  is  diagonal  with 

“in 

values  of  0.1  for  both  entries;  the  matrix  is  diagonal 

with  values  of  1.  for  both  entries;  finally  the  matrix 

is  the  zero  matrix.  The  command  model  is  written  to 
— m 

the  SAVE  file.  The  poles  of  the  commcuid  model  (A  matrix) 

— m 

are  computed  and  printed.  The  equations  defining  the  CGT 
controller  are  solved  euid  the  CGT/PI  feedforward  gains 


K  and  K  are  computed  and  printed  (since  the  design 
m  *u 

model  does  not  include  disturbance  states,  the  matrix  K 

^n 


does  not  exist) . 


(9)  The  CGT/PI  controller  is  evaluated  with 


respect  to  the  truth  model,  as  previously  defined.  A  time 

response  simulation  is  run  for  a  step  of  magnitude  1.  on 

command  model  input  1  (u  (1)  =  unit  step) ,  and  no  initial 

— m 

conditions  are  set  on  the  truth  model  states.  Two  plots 
are  printed  to  the  terminal  of  4  and  2  variables  each. 

The  first  plot  includes  (pairwise)  outputs  1  eind  2  of  the 
truth  model  cind  command  model  (plot  symbol  1  is  y(l)  , 
plot  symbol  2  is  Xj^^d),  and  so  on).  The  second  plot 
includes  states  5  and  6  of  the  truth  model  (these  are  the 


control  actuator  states) .  Since  the  first  plot  includes 
outputs  of  the  command  model,  a  single  scale  range  is 
applied  to  edl  four  vari^J^les  in  the  plot.  A  time  dura¬ 
tion  of  0.9  seconds  is  specified  (which  gives  the  first 
50  controller  samples  again) ,  and  a  title  is  entered. 
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The  resulting  time-response  plots  follow. 

(10)  No  additional  time -responses  of  the  CGT/PI 
controller  are  requested.  The  Kalman  filter  design  path 

is  then  selected.  Since  this  is  the  first  execution  of  the 
Kalman  filter  design,  the  noise  strength  matrices  (g  emd 
R)  specified  in  the  existing  definition  of  the  design  model 
are  used  to  compute  the  Kalman  filter  gain  matrix  (note  that 
in  subsequent  iteration  of  the  Kalman  filter  design  path, 
the  user  may  modify  the  diagonal  elements  of  the  noise 
strength  matrices) .  The  diagonal  elements  of  the  noise 
strength  matrices  and  the  entire  filter  gain  matrix  are 
printed.  Next,  a  title  is  entered  to  apply  to  the  plots 
of  state  estimation  error  stfmderd  deviations  (output  to 
LIST  file  only) .  The  final  values  of  true  and  filter- 
confuted  RMS  errors  for  the  design  model  state  estimates 
are  printed. 

(11)  The  filter  design  is  not  repeated,  nor  are 

any  of  the  other  designs.  Upon  terminating  execution,  the 

PI  gains  determined  previously  (Paragraph  (6))  are  written 

to  the  SAVE  file.  The  command  "PILES"  gives  a  listing  of 

existing  files.  Note  that  files  SAVE,  LIST,  and  PLOT  have 

been  generated  automatically  during  program  execution. 

The  SAVE  file  (containing  the  design,  truth,  and  command 

model  data  as  well  as  the  PI  gains  K  and  K  )  is  then 

~x  — z 

cataloged  for  future  use  (as  a  DATA  file) .  The  already 
existing  (attached)  DATA  file  is  then  returned  2md  the 
just  created  SAVE  file  is  copied  to  the  local  file  named 
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DATA.  Next,  the  LIST  file  is  sent  to  a  line  printer  for 
listing.  Finally,  the  SAVE  file  is  returned,  making 
re-execution  of  the  program  feasible  (since  SAVE  had  been 
made  a  permanent  file,  it  could  not  be  written  to  in  sub¬ 
sequent  executions) .  In  a  subsequent  execution,  the 
various  dynamics  models  2uid  the  PI  gains  would  be  avail- 
ed)le  from  the  new  DATA  file  and  a  new  SAVE  file  would  be 
created  (if  desired) .  However,  in  this  case  there  is  no 
repeated  execution  of  the  program,  and  the  user  enters  a 
"LOGOUT"  from  the  system. 
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(1) 


ASD  CaiPUTER  CENTER  -  INTERCai  5.1 
SYSTE'l  CSA 

DATE  11/19/31  TIME  09.48.56. 

PLEASE  LOGIN 
LOGIN, D790477  <]— 

UUXUIM  ENTER  PASSWORU- 


11/19/ai  LOGGED  IN  AT  09.49.34. 
WITH  USER-ID  PD 


COMMAND 
AT  CY* 
COMMAND 
Ca4MAND 
COTMAND 

COMMAND- 


EQUIP/PORT  16/051 
ATTACH, CGTPIF, THESIS  <j- 
100  SN*AFFDL 

ATTACH,  DATA,  DESIGN,  CY=1  <C— 
REQUEST,  SAVE,  *PF 
CONNECT,  INPUT,  OUTPUT 

CGTPIF  <J- 
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(2) 


*  •  *  CGTPIF  *  *  * 

i  PROGRA:-!  to  DCSIGH  a  Ca4t4AL«D  GEMERATOR  TRACKER 

(  USING  A  REGULATOR  WITH  PROPORTIONAL  PLUS  INTEGRAL  CONTROL 

!  AND  A  KALMAN  FILTER  FOR  STATE  ESTIMATION. 

*  *  *  CGTPIF  *  *  * 

f 

I  DATE  ;  11/19/81 

i  TIME  ;  09.50.33. 

r 

[  ENTER  SAMPLE  PERIOD  FOR  DIGITAL  CONTROLLER  >.02  <1— 


READ  DESIGN  MODEL  FROM  'DATA*  FILE  (Y  OR  N)  >Y  c;:;— 


'  MODIFY  MATRIX  ELEMENTS  (Y  OR  N)  >Y  <j- 

A  B  EX  G  Q  C  DY  EY  U 
ENTER  MATRIX  NA4E  >C  <?— 

LIST  MATRIX  TO  TERMINAL  (Y  OR  N)  >Y 

C  MATRIX 


1.000 

0. 

0. 

0. 

0. 

0. 

1.000 

-1.000 

0. 

0. 

0. 

0. 

ENTER  I,J  AND  M(l,J) — (0/  WHEN  COMPLETE)  : 

MODIFY  MATRIX  ELEMENTS  (Y  OR  N)  >N  <}- 

WRITE  DESIGN  MODEL  TO  ‘SAVE*  FILE  (Y  OR  W) 
DESIGN  MODEL  WRITTEN  TO  'SAVE*  FILE 

POLES  OF  DESIGN  MATRIX 

1.3497279E-03  +J( 

1.2965361E+00  + J ( 

-3.6658a59E+U0  + J ( 

-2 . OOOOOOOE+01  +J ( 

-2.00000U0E+01  +J( 

-4.9251429E-01  + J ( 

-2.25&4490E+01  + J ( 

-4.9251429E-01  + J ( 


0.  ) 

0.  ) 

0.  ) 

0.  ) 

0.  ) 

0.  ) 

0.  ) 

0.  ) 


tlN  R  AN 


0. 

0. 


2  BY  8  >0/  C  — 


>Y  <C— 


GN 
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(3) 


CONTROLLER  DESIGN  (Y  OR  N)  >Y  <]- 

DESIGN  REG/PI  (Y  OR  N)  >Y  <}- 

ENTER  WEIGHTS  ON  OUTPUT  DEVIATIONS:  2 

ENTER  I  AND  QW(I,I)  — (0/  WHEN  COMPLETE)  >1  200. 

2  200. 

0/  <3“ 

ENTER  WEIGHTS  ON  CONTROL  MAGNITUDES:  2 
ENTER  I  AND  0W(I,l) — (0/  WHEN  CUdPLETE)  >1  1.  <3- 
2  1.  <- 
0/  <C}“ 

ENTER  WEIGHTS  ON  CONTROL  RATES:  2 
ENTER  I  AND  QW(I,I)  — (0/  'WHEN  COIPLETE)  >1  1.  <}— 
2  1.  <- 
0/ 


Y  MATRIX 

200.0 
200.0 

m  MATRIX 

1.000 
1.000 

MODIFY  ELEMENTS  OF  'X'  MATRIX  (Y  OR  N)  >N 

UR  MATRIX 

1.000 
1.000 

KX  MATRIX 

-24.12  19.93  -1.127  1.090 

75  -67.99  2.4492E-02 

81.36  -83.53  .5534  1.1577E-02 

15  280.0  6.538dE-03 


1. 3509E-02 


1.034 


KZ  MATRIX 


.2172 

-2.925 


-.9149 

3.051 


I 


(4) 


CONTROLLER  EVALUATION  WRT  TRUTH  rfODEL  (Y  OR  N)  >y  ^ 

READ  TRUTH  MODEL  FROM  ‘DATA*  FILE  (Y  OR  N)  >Y  «<>- 

MODIFY  MATRIX  ELEMENTS  (Y  OR  N)  >N 

WRITE  TRUTH  MODEL  TO  ‘SAVE*  FILE  (Y  OR  J)  >Y 
TRUTH  MODEL  WRITTEN  TO  ‘SAVE*  FILE 

POLES  OF  TRUTH  MATRIX 

-1.75b2050E-02  + J (  1 . 3462117E-01 ) 

-1.7562050E-02  + J {  -1 . 3462117E-01) 


1.24d605i£+00  +J(  0.  ) 

-3.90229H6E+00  +J(  0.  ) 

-2.0000000E+01  +J(  0.  ) 

-2.0000000E+01  +J(  0.  ) 

-4.9251429E-01  +J(  0.  ) 

-2.2564490E+01  +J(  0.  ) 

-4.9251429E-01  •fJ(  0.  ) 
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(5) 


POLES  OF  REGPI  MATRIX 


-4.2981128E+00 

+J( 

0. 

) 

-1.0352022E-t-01 

+J( 

1. 

4079013E+01) 

-1.0352022E+01 

+J( 

-1. 

4079013E+01) 

-2.4472260E+01 

+J( 

0. 

) 

-1.9bl2664C't-01 

+J( 

0. 

) 

-5.4860340E+01 

+J( 

0. 

) 

-5.4957660E+01 

+J( 

0. 

) 

-2. 2564493E+01 

+J( 

0. 

) 

-4.9251461E-01 

+J( 

0. 

) 

-4.925139OE-01 

+J( 

0. 

) 

ENTER  STATE  AND  IC  VALUE  (0/  TER-1 INATES )  :  9  >1  .01  <Cj— 

2  -.01 
0/  O- 

2  PLOTS  OF  5  VARIABLES  MAY  BE  PRINTED  AT  THE  TERMINAL  —  SPECIFY  NUMBER 
FOR  EACH  (N1,N2)  >20  <3- 

ENTER  OUTPUTS  BY  TYPE  AND  INDEX  IN  2  ENTRIES — TYPES  ARE 
STATE  :  'X' 

OUTPUT  ;  'Y* 

INPUT  ••  'U* 

PLOT  1 

OUTPUT  1  >Y  <3^- 
>1  <- 
OUTPUT  2  >Y 
>  2 

ENTER  TIME  DURATION  FOR  RESPONSE,  IN  SECONDS  >.9 

+ - ENTER  TITLE  IK  GIVEN  FIELD - + 

AFTI(S3, A2,G3)  PITCH  POINTING  PI  <j- 
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I 


AFT1(S3. A2,G3)  PITCH  POINTING  PI 


0.00 

+ 

+ 

+ 

+  1 

2 

.02 

+ 

+ 

+ 

+  21 

+ 

.04 

+ 

+ 

+ 

+ 

2+  1 

+ 

.06 

+ 

+ 

+ 

+  2 

+  1 

+ 

.08 

+ 

+ 

+ 

2  + 

+  1 

+ 

.10 

+ 

+ 

+  2 

+ 

+1 

+ 

.12 

+ 

+ 

2  + 

+ 

1  + 

+ 

.14 

+ 

+ 

2 

+ 

+  1 

+ 

+ 

.16 

+ 

+  2 

+ 

+1 

+ 

+ 

.18 

+  :  :  : 

:  :+:2: 

;  5  +  2  •  • 

•  1  •  ^  •  •  • 

•  A  •  «  •  •  • 

;  + 

.20 

+ 

+2 

+  1 

+ 

+ 

+ 

.22 

+ 

2 

+  1 

+ 

+ 

+ 

.24 

+ 

2 

1+ 

+ 

+ 
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1 

+ 
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+ 
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+ 
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+ 
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+ 
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+ 

2  1 

+ 

+ 

+ 

+ 
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+ 

2  + 

+ 

+ 

+ 

+ 

.34 

+ 

12  + 
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+ 

+ 

+ 

.36 

+  1 

2  + 

+ 

+ 

+ 

+ 

.38 

+  :  1  ; 

2:  ;+:  : 

; 

•  •  4  •  •  * 

;  + 

.40 

+  1 

2  + 

+ 

+ 

+ 

+ 

.42 

+1  2 

+ 

+ 

+ 

+ 

+ 

.44 

1  2 

+ 

+ 

+ 

+ 

+ 

.46 

1  2 

+ 

■r 

+ 

+ 

+ 

.48 

1  2 

+ 

+ 

+ 

+ 

+ 

.50 

1  2 

+ 

+ 

+ 

+ 

+ 

.52 

1  2 

+ 

+ 

+ 

+ 

+ 

.54 

+12 

+ 

+ 

+ 

+ 

+ 

.56 

+  2 

+ 

+ 

+ 

+ 

+ 

.58 

+2  1  : 

•  •  4^  *  • 

• 

• 

:  + 

.  60 

+2  1 

+ 

+ 

+ 

+ 

+ 

.62 

+2 

1  + 

+ 

+ 

+ 

+ 

.64 

+2 

1  + 

+ 

+ 

+ 

+ 

.  66 

+2 

1 

+ 

+ 

+ 

+ 

.  68 

+2 

+  1 

+ 

+ 

+ 

+ 
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+2 

+  1 

+ 

+ 

+ 

+ 

.72 

+2 

+ 

1 

+ 

+ 

+ 
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+2 

+ 

1  + 

+ 

+ 
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+ 

+1 

+ 

+ 

+ 
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+  :  2 ;  : 

•  ;  + ;  ; 

:  ;  + :  1  : 

:  + 

.60 

+  2 

+ 

+  1 

+ 

+ 

+ 

.82 

+  2 

+ 

+ 

1  + 

+ 

+ 

.84 

+  2 

+ 

+ 

1  + 

+ 

+ 

.86 

+  2 

+ 

+ 

+1 

+ 

+ 

.88 

+  2 

+ 

+ 

+  1 

+ 

+ 

.90 

+  2 

+ 

+ 

+  1 

+ 

+ 

.92 

+  2 

+ 

+ 

+  1 

+ 

+ 

.94 

+ 

2  + 

+ 

+ 

1  + 

+ 

.96 

+ 

2  + 

+ 

+ 

1  + 

+ 

.98 

+  :  :  ; 

2  :  + :  ; 

• 

• 

i  :  +  :  :  : 
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:  + 

1.00 

+ 

2  + 

+ 

+ 

1+ 
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SCALE  1 

-.0090 

-.0050 

-.0010 

.0030 

.0070 

.0110 

SCALE  2 

-.0050 

-.0000 

.0050 

.0100 

.0150 

.0200 

MORE  TIME  RESPONSE  RUNS  (Y  OR  N)  >N  <1— 

CONTROLLER  DESIGN  (Y  OR  N)  >Y  <}- 

DESIGN  REG/PI  (Y  OR  N)  >Y  «<}- 

ENTER  WEIGHTS  ON  OUTPUT  DEVIATIONS:  2 

ENTER  I  AND  QW(I,I)~(0/  WHEN  CO'IPLETE)  >0/ 

EiOTCR  WEIGHTS  ON  CONTROL  MAGNITUDES:  2 

ENTER  I  AND  QW(l,I)— (0/  VJHEN  COMPLETE)  >i^/  <  — 

ENTER  WEIGHTS  ON  CONTROL  RATES:  2 

ENTER  I  AND  QW(I,I) — (0/  WHEN  CQIPLETE)  >0/ 

Y  MATRIX 

200.0 

200.0 

DM  -lATRIX 

1.000 

1.000 

MODIFY  ELE'IENTS  OF  'X'  MATRIX  (Y  OR  N)  >y  <  — 

LIST  'X'  MATRIX  TO  TERMINAL  {Y  OR  N)  >N  — 

ENTER  I.J  AND  M(I.J)  —  (0/  WHEN  CODIPLETE)  :  10  BY  10  >3  3  50.  — 

0/ 

UR  MATRIX 

1.000 

1.000 


KX 

MATRIX 

-38.87 

19.69  -1.687 

1.282 

5. 7119E 

51 

-05.16 

2.9332E-02 

78.03 

-83.61  .4227 

5. 5022E-02 

1.045 

24 

230.0 

7.6946E-03 

KZ 

MATRIX 

7.0350E-03  -.8717 

-2.929  3.068 


(7) 


CONTROLLER  EVALUATION  WRT  TRUTH  MODEL  (Y  OR  N)  >¥  <J- 
MODIFY  TRUTH  MODEL  (Y  OR  N)  >N  <]- 

POLES  OF  REGPI  MATRIX 

-2.9327602E+01  +J(  4. 2991187E+01 ) 

-2.9827602E+01  +J(  -4. 29911b7E+01 ) 

-1.9616067E+01  +J(  0.  ) 

-5.4953050E+01  +J(  0.  ) 


-5.4953050E+01  + J ( 
-2. 2652939E+0U  + J ( 
-7.3649808E+01  + J ( 
-3.a538426E+00  + J ( 
-2.2564493E+01  +J{ 
-4.9251429E-01  + J ( 
-4.9251429E-01  +J( 


0.  ) 

0.  ) 

0.  ) 

0.  ) 

0.  ) 

2.3149970i:-09) 


-4.9251429E-01  +J(  -2. 3149970E-09 ) 

ENTER  STATE  AND  IC  VALUE  (0/  TERMINATES):  9  >1  .01  v.  — 

2  -.01 
0/ 

2  PLOTS  OF  5  VARIABLES  MAY  BE  PRINTED  AT  THE  TERMINAL  —  SPECIFY  NUMBER 
FOR  EACH  (N1,N2)  >2  0 

ENTER  OUTPUTS  BY  TYPE  AI^D  INDEX  IN  2  ENTRIES— TYPES  ARE 
STATE  :  'X* 

OUTPUT  ;  *Y' 

INPUT  ;  'U' 

PLOT  1 

OUTPUT  1  >Y  <T- 
>  1 

OUTPUT  2  >Y  <— 

>2  <3- 

ENTER  TIME  DURATION  FOR  RESPONSE,  IK  SECONDS  >.9  <J— 

+ - ENTER  TITLE  IN  GIVEN  FIELD - + 

AFTI(S3, A2,G3)  PITCH  POINTING  PI’ 


AFTI(S3. A2,G3)  PITCH  POINTING  PI 


0.00 

+ 

+ 

+ 

+ 

+  2 

1 

.02 

+ 

+ 

+ 

+ 

+  2 

1  + 

.04 

+ 

+ 

+ 

+  2 

f  1 

+ 

.06 

+ 

+ 

+ 

2 

+1 

+ 

.08 

+ 

+ 

+  2 

+  1 

+ 

+ 

.10 

+ 

+ 

2  + 

1  + 

+ 

.12 

+ 

2 

1+ 

+ 

+ 

+ 

.14 

+ 

+2 

1 

+ 

+ 

+ 

+ 

.16 

+ 

12  + 

+ 

+ 

+ 

.13 

+  ;  ;  1  ; 

2 ;  :  +  : 

•  • 

:  ;+:  :  ;  ; 

•  ^  •  2  • 

;  :  + 

.20 

+  12 

+ 

+ 

+ 

+ 

+ 

.22 

+  12 

+ 

+ 

+ 

+ 

+ 

.24 

+  2 

+ 

+ 

+ 

+ 

+ 

•  26 

+2  1 

+ 

+ 

+ 

+ 

+ 

.28 

+2 

1  + 

+ 

+ 

+ 

+ 

.30 

2 

1  + 

+ 

+ 

+ 

+ 

.32 

2 

1+ 

+ 

+ 

+ 

+ 

.34 

2 

+1 

+ 

+ 

+ 

+ 

.  36 

+2 

+ 

1 

+ 

+ 

+ 

+ 

.  38 

+2  :  : 

:  :  ^ : 

1  ;  ! 

:  :+;  :  ; 

:  :+;  ;  :  : 

•  +  ;  ;  ; 

:  ;  + 

.40 

+2 

+ 

1 

+ 

+ 

+ 

+ 

.42 

+2 

+ 

1 

+ 

+ 

+ 

+ 

.44 

+2 

+ 

1 

+ 

+ 

+ 

+ 

.46 

+2 

+ 

1 

+ 

+ 

+ 

+ 

.48 

+  2 

+ 

1 

+ 

+ 

+ 

+ 

.50 

+  2 

+ 

1 

+ 

+ 

+ 

+ 

.52 

+  2 

+ 

1 

+ 

+ 

+ 

+ 

.54 

+  2 

+ 

1 

+ 

+ 

+ 
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.56 

+  2 

+ 

1 

+ 

+ 

+ 

+ 

.  58 

+ :  2 : 

:  :4-: 

:  1 :  J 

1  :  + ;  ;  : 

.  :+:  :  :  : 

•  ^  •  •  • 

*  »  •  •  • 

:  .  + 

.60 

+  2 

+ 

1 

+ 

+ 

+ 

+ 

.62 

+  2 

+ 

1 

+ 

+ 

+ 

+ 

.64 

+  2 

+ 

1 

+ 

+ 

+ 

+ 
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+  2 

+ 

1 

+ 

+ 

+ 

+ 

.  63 

+  2 

+ 

1 

+ 

+ 

+ 

.70 

+  2 

+ 

1 

+ 

+ 

+ 

+ 

.72 

+  2 

+ 

1 

+ 

+ 

+ 

+ 

.74 

+  2 

+ 

1 

+ 

+ 

+ 

+ 

.  76 

+  2 

+ 

1 

+ 

+ 

+ 

+ 

.78 

+  :  2  : 

;  ;  +  : 

;  1  : 

:  :+:  :  :  ; 

:  + :  :  : 

;  :  + 

.80 

+  2 

+ 

1 

+ 

+ 

+ 

+ 

.32 

+  2 

+ 

1 

+ 

+ 

+ 

+ 

.84 

+  2 

+ 

1 

+ 

+ 

+ 

.  86 

+  2 

+ 

1 

+ 

+ 

+ 

+ 

.  88 

+  2 

+ 

1 

+ 

+ 

+ 

+ 

.90 

+  2 

+ 

1 

+ 

+ 

+ 

+ 

.92 

+  2 

+ 

1 

+ 

+ 

+ 

+ 

.94 

+  2 

+ 

1 

+ 

+ 

+ 

+ 

.96 

+  2 

+ 

1 

+ 

+ 

+ 

+ 

.98 

+  ;  :2: 

:  ;  +  ; 

;  :li 

•  *  •  • 

:  ;+:  :  :  ; 

•  ^  j  j  j 

;  :  + 

1.00 

+  2 

+ 

1 

+ 

+ 

+ 

+ 

SCALE  1 

-.0050 

-.0020 

.0010 

.0040 

.0070 

.0100 

SCALE  2 

-.0030 

.0020 

.0070 

.0120 

.0170 

.0220 

155 


(8) 


MORE  TIME  RESPONSE  RUNS  (Y  OR  N)  >N  <}- 
CONTROLLER  DESIGN  (Y  OR  N)  >Y 
DESIGN  REG/PI  (Y  OR  N)  >N  <}- 
DESIGN  CGT  (Y  OR  N)  >V 

READ  CO-IMANU  MODEL  FROM  ‘DATA*  FILE  (Y  OR  N)  >N  . 
ENTER  COMMAND  MODEL  FRO'l  TERMINAL  (Y  OR  N)  >Y  <J— 
ENTER  NM  >2  <^— 

ENTER  RM  >2  <J- 
ENTER  PM  >2 


ENTER  A1 

ENTER  I.J  AND  — (0/  WHEN  COMPLETE) 

2  2-5. 

0/  <- 

ENTER  DM 

ENTER  l.J  AND  M(I,J) — (0/  Wr.-  .  ^.,..PL2TE) 

2  2  .1  <C— 

0/  <- 

ENTER  C'l 

ENTER  I.J  AND  •Ul,J)--(0/  NMEN  CO-iPLETL) 

2  2  1. 

0/  ^  _ 

ENTER  DM 

ENTER  I.J  AND  M(I,J) — (0/  VWEN  CQIPLETE) 
MODIFY  MATRIX  ELEMENTS  (Y  OR  N)  >N 


2  BY  2  >11-5.'— 


2  3Y  2  M  1  .1  •  — 


2  DY  2  >1  1  1.  •  - 


2  BY  2  >0/  <C— 


i/RITE  COMMAND  MODEL  TO  'SAVE*  FILE  (Y  OA  U)  >Y 
COMMAND  MODEL  WRITTEN  TO  'S/iVE’  FILE 

POLES  OF  CO.IMAND  MATRIX 

-5.0000000E+00  +J(  0.  ) 

-5.0000U00E+00  +J(  0.  ) 

KKi  MATRIX 

-9.482  -14.92 

-18.47  61.13 

KXU  MATRIX 

-.1181  -.1711 

-2.1486E-02  .7287 


(9) 


CONTROLLER  EVALUATION  WRT  TRUTH  40UEL  (Y  OR  N)  >Y  <J- 
MODIFY  TRUTH  MODEL  (Y  OR  N)  >N  <C}“ 

ENTER  MODEL  INPUT  AND  STEP  VALUE  ;  1  >1  1.  — 

ENTER  STATE  AND  IC  VALUE  (0/  TERMINATES);  9  >0/  — 

2  PLOTS  OF  5  Variables  may  be  printed  at  the  terminal  —  specify  number 
FOR  EACH  (N1,N2)  >4  2 

enter  outputs  by  type  and  index  in  2  ENTRIES — TYPES  ARE 


STATE  ; 

•X' 

OUTPUT  ; 

• 

Y' 

INPUT  ; 

'u 

1 

MODEL  . 

•m 

• 

PLOT  1 

OUTPUT 

1 

>Y 

>1 

OUTPUT 

2 

>M 

>1 

OUTPUT 

3 

>Y 

>2 

OUTPUT 

4 

>M 

>2 

PLOT  2 

OUTPUT 

1 

>X 

>5 

OUTPUT 

2 

>X 

>6 

ENTER  TIME  DURATION  FOR  RESPONSE,  IN  SECONDS  >.9  — 

+ - ENTER  TITLE  IN  GIVEN  FIELD - + 

AFTI(S3, A2, G3)  PITCH  POINTING  CGT/PI  •  — 


AFT1{S3, A2,G3)  PITCH  POINTING  CGT/PI 


0.00 

+  4 

+ 

+ 

+ 

+ 

+ 

.02 

+34  2 

+ 

+ 

+ 

+ 

+ 

.04 

+341 

2+ 

+ 

+ 

+ 

+ 

.06 

3  4  1 

+  2 

+ 

+ 

+ 

+ 

.08 

3  4 

1  +  2 

+ 

+ 

+ 

+ 

.10 

3  4 

+1 

2  + 

+ 

+ 

+ 

.12 

3  4 

+  1 

2 

+ 

+ 

+ 

.14 

3  4 

+ 

1  +  2 

+ 

+ 

+ 

.16 

3  4 

+ 

+  12 

+ 

+ 

+ 

.18 

3:4:  : 

•  •  •  •  • 

•  •  »  ♦  •  • 

:  ;+;  :  2 

•  ^  * 

:  ;  + 

.20 

3  4 

+ 

+ 

21  + 

+ 

+ 

.22 

3  4 

+ 

+ 

2  1 

+ 

+ 

.  24 

+34 

+ 

+ 

2+  1 

+ 

+ 

.26 

+34 

+ 

+ 

+2  1 

+ 

+ 

.  28 

+34 

+ 

+ 

+  2  1 

+ 

+ 

.30 

+34 

+ 

+ 

+  21 

+ 

+ 

.  32 

+34 

+ 

+ 

+  21 

+ 

+ 

.34 

+  4 

+ 

+ 

+  2  1 

+ 

+ 

.  36 

+  4 

+ 

+ 

+  21 

+ 

+ 

.  38 

+ ;  4 ;  : 

*  •  ^  •  «  • 

:  :  + :  ;  ;  21 

•  ^  •  •  • 

•  ’  •  •  • 

:  :  + 

.40 

+  4 

+ 

+ 

+  21 

+ 

+ 

.42 

+  4 

+ 

+ 

+  2 

+ 

+ 

.44 

+  4 

+ 

+ 

+  21 

+ 

+ 

.46 

+  4 

+ 

+ 

+  21 

+ 

+ 

.48 

+  4 

+ 

+ 

+  2 

+ 

+ 

.50 

+  4 

+ 

+ 

+  21  + 

+ 

.  52 

+  4 

+ 

+ 

+ 

2+ 

+ 

.54 

+  4 

+ 

+ 

+ 

2+ 

.56 

+  4 

+ 

+ 

+ 

21 

+ 

.  58 

+  ;4:  ; 

21:  ;  :  ; 

:  :  + 

.  60 

+  4 

+ 

+ 

+ 

2 

+ 

.62 

+  4 

+ 

+ 

+ 

2 

+ 

.64 

+  4 

+ 

+ 

+ 

21 

+ 

.66 

+  4 

+ 

+ 

+ 

21 

+ 

.  6B 

+  4 

+ 

+ 

+ 

21 

+ 

.  70 

+  4 

+ 

+ 

+ 

21 

+ 

.  72 

+  4 

+ 

+ 

+ 

21 

+ 

.  74 

+  4 

+ 

+ 

+ 

+2 

+ 

.  76 

+  4 

+ 

+ 

+ 

+2 

+ 

.  78 

+  :4;  ; 

•  •  •  •  • 

;  :  + :  ;  ;  : 

:+2  :  : 

.  :  + 

,80 

+  4 

+ 

+ 

+ 

+2 

+ 

.82 

+  4 

+ 

+ 

+ 

+2 

+ 

.84 

+  4 

+ 

+ 

+ 

+2 

+ 

.86 

+  4 

+ 

+ 

+ 

+2 

+ 

.88 

+  4 

+ 

+ 

+ 

+2 

+ 

.90 

+  4 

+ 

+ 

+ 

+2 

+ 

.92 

+  4 

+ 

+ 

+ 

+2 

+ 

.94 

+  4 

+ 

+ 

+ 

+2 

+ 

.96 

+  4 

+ 

+ 

+ 

+2 

+ 

.98 

+ :  4 :  : 

•  •  1  •  •  • 

;  +2  ;  ; 

:  :  + 

1.00 

+  4 

+ 

+ 

+ 

+2 

+ 

SC7VLE 

-.0010 

.0040 

.0090 

.0140 

.0190 

•  < 
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AFTI(S3,A2,G3)  PITCH  POINTIUG  CGT/PI 


0.00 

+ 

+  1 

+ 

+  2 

+ 

.02 

+  1 

•f 

+ 

•f 

+  2 

.04 

1 

+ 

•f 

•f 

2 

+ 

.06 

+  1 

+ 

•f 

•••  2 

+ 
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.08 

+ 

•►I 

■f 

2 

+ 

+ 

.10 

1 

2+ 

+ 
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.12 

+ 
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21  ♦ 
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.14 

+ 

+  2 

+  1 

+ 

+ 

.16 

+ 

+ 

+  2 

+ 

+1 

+ 

.  18 

^  •  •  •  • 

<  •  •  •  • 

•  ^  •  •  • 

•  >  •  •  • 

♦  *  ?  *  *  * 

•  •  *  •  •  X  • 

:  + 

.20 

+ 

•I- 

2+ 

+ 

+  1 

+ 

.22 

+ 

+ 

2  + 

+ 

+  1 

+ 

.24 

+ 

+  2 

+ 

+ 

+  1 

+ 

.26 

+ 

+  2 

+ 

+ 

+  1 

.28 

+ 

+  2 

+ 

+ 

+  1 

+ 

.  30 

+ 

2 

+ 

+ 

+  1 

+ 

.  32 

+ 

2+ 

+ 

+ 

+  1 

+ 

.  34 

2  + 

+ 

+ 

+1 

+ 

.  35 

+  2 

+ 

+ 

+ 

1 

+ 

.  33 

+  s  :  :  2  : 

•  ^  • 

1+:  :  1  : 

;  + 

.40 

+  2 

+ 

+ 

+ 

1  + 

+ 

.42 

+  2 

+ 

+ 

+ 

1 

+ 

.44 

+  2 

+ 

+ 

+ 

1 

+ 

.  46 

+  2 

+ 

+ 

+ 

1 

+ 

.43 

+  2 

+ 

+ 

+ 

+1 

+ 

.  50 

+  2 

+ 

+ 

+ 

+1 

+ 

.  52 

+  2 

+ 

+ 

+ 

+  1 

+ 

.54 

+  2 

+ 

+ 

+ 

+  1 

+ 

,  56 

+  2 

+ 

+ 

+ 

+  1 

+ 

.58 

+  :  2  :  ; 

•  ^  •  •  • 

;  :+:  :  : 

:+: 1 ;  :  : 

;  + 

.60 

+  2 

+ 

+ 

+ 

+  1 

+ 

.62 

+  2 

+ 

+ 

+ 

+  1 

+ 

.  64 

+  2 

+ 

+ 

+ 

+  1 

+ 

.  6b 

+  2 

+ 

+ 

+ 

+  1 

+ 

.  68 

+  2 

+ 

+ 

+ 

+  1 

+ 

.70 

+  2 

+ 

+ 

+ 

+  1 

+ 

.  72 

+2 

+ 

+ 

+ 

+  1 

+ 

.  74 

+2 

+ 

+ 

+ 

+  1 

+ 

.76 

+2 

+ 

+ 

+ 

+  1 

+ 

.  73 

+2  :  ;  ; 

•  ^  •  •  • 

•  •  1  !  •  • 

:  + 

.80 

+2 

+ 

+ 

+ 

+  1 

+ 

.82 

+2 

+ 

+ 

+ 

+  1 

+ 

.  84 

+2 

+ 

+ 

+ 

+  1 

.86 

+2 

+ 

+ 

+ 

+  1 

+ 

.88 

+2 

+ 

+ 

+ 

+  1 

+ 

.90 

+2 

■f 

+ 

+ 

+  1 

+ 

.92 

+2 

+ 

+ 

+ 

+  1 

+ 

.94 

+2 

+ 

+ 

+ 

+  1 

+ 

.96 

+2 

+ 

+ 

+  1 

+ 

.  98 

+2  :  :  : 

•  *  J  J 

;  :+:l:  ;  ; 

:  + 

1.00 

+2 

+ 

+ 

+ 

+  1 

+ 

SCALE  1 

-.0490 

-.0290 

-. 0090 

.0110 

.0310 

.  0510 

SCALE  2 

-. 1400 

-.1100 

-.0300 

-.0500 

-.0200 

.  0100 
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(10) 


MORE  TIME  RESPONSE  RUNS  (Y  OR  N)  >N  <}- 
CONTROLLER  DESIGN  (Y  OR  N)  >N  <3- 
PILTER  DESIGN  (Y  OR  N)  >Y  <3— 

Q  SIATRIX 

1.000 

R  MATRIX 

4. 7600E-06 
1.2200E-05 
3. 2200E-05 

KF  MATRIX 

4.4140E-02 
1.8745E-02 
6.7043E-02 
-G.759yE-!32 
2. 2655E-91 
-1.736 
-1.4593E-02 
-3.4765E-02 
MODIFY  TRUTH  > 

POLES  OF  FILTER  MATRIX 


-2.1736993E+01  +J(  0.  ) 
-1.5709760E+01  +J(  0.  ) 
-2. 3546296E+00  + J (  1 . 2B11239E+00 ) 
-2.3546296L+00  + J (  -1 . 2ail239E+00 ) 
-5.6279ia7E-05  +J(  0.  ) 

-2.04438470-01  +J(  0.  ) 
-2.00000U1E+01  +J(  0.  ) 
-2.0000001E+01  +J(  0.  ) 


+ -  ENTER  TITLE  IN  GIVEN  FIELD 

AFTI(S3, A2,G3)  KALMAN  FILTER  C^— 


1.6200E-03 
-2.6979E-02 
-2. 7613E-03 
4.6574E-90 
-1. 56uaE-a9 
34.37 
.  2386 
2.068 

DEL  (Y  OK  N) 


9.910a£-03 
-7.9667E-03 
4. 5761E-02 
3.4539E-91 
-1.1575E-90 
1.423 

6.9205E-03 
-. 1628 
>N  <;— 
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FINAL  RMS  ERRORS  :  TRUE  «  4. 5419573E-04 

(STATE  1)  COlPUTED  »  4. 7274126E-04 

FINAL  R4S  ERRORS  :  TRUE  «  4. 9942017E-04 

(STATE  2)  CmPUTED  *  5 . 31291B9E-04 

FINAL  RMS  ERRORS  :  TRUE  »  1 . 2360643E-03 

(STATE  3)  CQ4PUTED  =  1 . 2525561E-03 

FINAL  R'IS  ERRORS  :  TRUE  =  2. 4935549E-92 

(STATE  4)  COMPUTED  »  1 . 1593964E-83 

FINAL  RMS  ERRORS  :  TRUE  »  8. 35670cJ4E-92 

(STATE  5)  COMPUTED  =  3 . a855003E-03 

FINAL  RMS  ERRORS  :  TRUE  =  2. 7032759E-01 

(STATE  6)  COMPUTED  =  3 . 0440785E-01 

FINAL  RMS  ERRORS  :  TRUE  =  1 . 8o5374UE-03 

(STATE  7)  COMPUTED  =  2 . 095209yE-03 

FINAL  RMS  ERRORS  ;  TRUE  =  2. 0671 737E-02 

(STATE  8)  COMPUTED  =  2 . 2234682E-02 
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(11) 


FILTER  DESIGN  (Y  OR  N)  >N  <3- 

END  DESIGN  RUNS  (Y  OR  N)  >Y  <}- 

REG/PI  GAINS  WRITTEN  TO  ‘SAVE*  FILE 


PROGRAM  EXECUTION  STOP 
STOP 


064700  lAXIplU:-!  EXECUTION  FL. 

23.723  CP  SECONDS  EXECUTION  TIME. 

CQ'IMAND-  FILES  <j- 
— -LOCAL  FILES- 

PLOT  LIST  SAVE  *CGTPIF  *DATA 

$INPUT  ^OUTPUT 
Ca-iMAND-  CATALOG,  SAVE,  DATAPP 
NEWCYCLE  CATALOG 
RP  «  008  DAYS 

CT  ID*  D7S0477  PFN=DATAPP 

CT  CY*  002  SN*AFFDL  00000763  iiORDS.  : 

CO,4MAND-  RETURN,  DATA  <3- 
COMMAND-  COPYDF,  SAVE,  DATA  <C  — 

Ca4MAND-  ROUTE, LIST, DC*PR, TID=91 , ST=CSB, FlD*aLL 


CQIMAND-  RETURN, SAVE 
CaiMAIJD-  LOGOUT 

CPA  28.999  SEC.  23.631  ADJ. 


10  118.959  SEC. 

CRUS 

CO.JWECT  TIME  0  HRS. 
11/19/81  LOGGED  OUT  AT 


35.211  ADJ. 
75.329 
24  MIN. 
10.13.32. 
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C.2 


1 


CGTPIF  Output  to  LIST  File 

Output  written  to  the  LIST  file  for  this  execu¬ 
tion  is  identified  according  to  the  corresponding  para¬ 
graph  description  of  Section  C.1.2  above.  Paragraphs  1 
euid  11  are  not  discussed  here  since  they  do  not  involve 
program  execution  and  therefore  do  not  affect  the  LIST 
file. 

(2)  The  first  output  is  a  heading  with  date  and 

time  identical  to  that  printed  at  the  terminal.  Next  the 

sample  period  of  the  controller  is  identified.  A  series  of 

outputs  related  to  the  design  model  then  follow;  these  are 

identified  by  a  heading  "DESIGN  MODEL".  First  the  matrices 

defining  the  continuous-time  representation  are  printed. 

For  this  case  the  matrices  are  k,  B,  G,  Q,  C,  D^,  H,  and  R. 

As  for  the  terminal  output,  the  eigenvalues  of  A  are  then 

printed.  Finally,  the  matrices  of  the  discrete-time 

representation  are  printed:  Q  ,  and  H  .  An  addi- 

®d  ^ 

tional  output  is  the  matrix  n  under  a  heading  of  "CON¬ 
TROLLER  SETUP". 

(3)  Output  relating  to  the  design  of  the  PI 
regulator  is  identified  by  a  heading  of  "REG/PI  DESIGN". 

The  quadratic  weighting  matrices  Y,  U  ,  X,  and  U-  are 
printed,  followed  by  the  regulator  gain  solution 
Finally,  the  PI  gains  K  and  K  are  printed. 

(4)  The  truth  model  description  is  identified  by 
the  heading  "TRUTH  MODEL"  and  in  this  case  lists  the 
matrices  of  the  continuous-time  system  first: 
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The  eigenvalues  of  the 


-t'  Qt'  -t'  -t'  -DT* 
matrix  are  then  printed.  The  matrices  of  the  discrete¬ 
time  representation  are  listed:  B.  /  • 

^  "^d  ^d 

(5)  Outputs  due  to  the  controller  evaluation 

routines  are  identified  by  a  heading  of  "CONTROLLER 
EVALUATION"  and  begin  with  the  mapped  eigenvalues  of  the 
closed-loop  system  with  PI  regulator,  Time-responses 

are  output  in  three  plots  of  5,  5,  and  3  variables  each. 
Each  plot  is  labeled  with  the  title  specified  by  the  user; 
the  plots  include  101  time  samples  extending  from  0.  to  2. 
seconds  at  the  controller  saunple  period  of  0.02  seconds; 
the  plot  width  is  100  character  positions  in  width.  The 
first  plot  is  of  states  1  through  5  (x^d)  to 

the  truth  model;  the  second  plot  is  of  states  6  through  9 
(x^(6)  to  x^(9))  and  output  1  (y(l) )  of  the  truth  model; 
the  final  plot  is  of  output  2  (^(2))  and  of  inputs  1  and  2 
(u^(l)  and  u^(2))  of  the  truth  model. 

(6)  The  second  execution  of  the  PI  regulator 
design  provides  the  same  outputs  as  described  in  Para¬ 
graph  (3)  above. 

(7)  The  controller  evaluation  of  the  PI  regulator 
design  provides  the  same  outputs  as  described  in  Paragraph 
(5)  above. 

(8)  The  CGT/PI  design  path  begins  with  definition 
of  the  command  model,  with  relevant  output  identified  by 
the  heading  "COMMAND  M(X)EL".  The  matrices  A  ,  B  ,  C  , 

2md  D  of  the  continuous-time  system  are  printed,  followed 


by  the  eigenveilues  of  the  matrix  A  .  The  discrete-time 

“iD 

matrices  ♦  »  B  ,  C  ,  and  D  are  then  printed.  Outout 
~ni 

due  to  the  CGT  design  computations  is  identified  by  the 

heading  "CGT  DESIGN".  The  matrices  A2j^f  —12' 

A22  printed.  Finally#  the  CGT/Pl  control  gain  matrices 

K  and  K  are  printed. 

*m  *u 

(9)  The  evaluation  of  the  CGT/PI  controller  is 
identified  by  the  header  "CONTROLLER  EVALUATION".  Three 
plots  are  printed  with  5,  5,  and  5  variables.  Character¬ 
istics  of  these  plots  are  the  same  as  described  in  Para¬ 
graph  (5)  eUaove.  The  first  two  plots  include  the  same 
truth  model  states  and  outputs  as  before.  The  third  plot 
includes  output  2  (y(2)),  and  inputs  1  and  2  (u^(l)  emd 
u. (2))  of  the  truth  model#  and  outputs  1  and  2  (y_(l)  and 

y  (2))  of  the  comiimnd  model. 

■^m 

(10)  Output  due  to  the  Kalmem  filter  design 

routines  is  identified  by  the  heading  "FILTER  DESIGN"# 

and  includes  the  noise  strength  matrices  Q  and  R  and  the 

Kalman  filter  gain  matrix  Kp.  The  output  of  the  filter 

evaluation  routines  is  identified  by  the  heading  "FILTER 

EVALUATION".  First#  the  mapped  poles  of  the  filter-system 

matrix  are  printed.  During  the  covariance  analysis 
*“j\r 

the  full  error  covariance  matrix  is  printed  at  each  time 
san^le  (in  this  case#  from  0.  to  1.  second  each  0.02 
seconds) .  Finally#  8  plots  are  printed:  each  plot  includes 
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the  standard  deviations  of  the  "true*  and  filter-computed 
estimation  error  for  each  design  model  state  for  50  con¬ 
secutive  time  samples  taken  at  the  controller/filter  sample 
period . 


Appendix  D 


CGTPIF  Program  Listing 

The  following  program  listing  includes  all  routines 
of  CGTPIF  as  discussed  in  the  "Programmer's  Manual". 

Routines  of  the  'LIBRARY*  object  file  are  not  listed  (Ref  24) 

CGTPIF  is  composed  of  three  parts:  a  'MAIN'  routine, 
an  optional  set  of  user-provided  routines,  and  a  large  set 
of  invariant  routines  referred  to  as  'CGTPIF  SUBS'.  In 
this  listing,  routines  *DSND',  'DSNM',  'TRTHD' ,  and  'TRTHM' 
are  optional  routines  that  are  of  standard  type  (see  Sec¬ 
tion  A. 10  of  Appendix  A);  routines  'ACDATA',  'GUSTS',  and 
'TBLUPl '  are  optional  routines  that  are  auxiliary  to  the 
stemdard  optional  routines.  These  optional  routines  are 
used  in  establishing  the  design  model  AFTI (S3,A2,G3)  for 
the  pitch-pointing  controller,  and  the  truth  model 
AFTI (S4 ,A2,G3) ,  both  as  described  in  Chapter  VI  of  this 
report.  Routines  'CGTXQ'  through  'VARSCL'  constitute  the 
set  of  routines  CGTPIF  SUBS. 
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■  " 


PROGRAH  MAlN(INPUTK64«0UTPUTs64tLXSTs64« 

1  SAV?»64,DATA«64«PL0Ts64» 

1  TAPE5*INPUT,TAPE6sOUTPUTtTAPE25«SAVtfTAPt5'J*DATA, 

2  TAPE99«PL0T,TAPE16*LISTl 
COHHON/HAZNl/NOZHtNOlHltCOHl  (4i^:  ) 

COMMON/MA IN2/COH2 (43f I 
COPHON/ZNOU/KZNtKOUTtKPUNCH 
COHHON/rZLPS/KSAV£,KOATA«KPLOT,KLZST*KTERH 
CONHCN/SYSHTX/N VSH,  SM  f  2125) 

COMMON /7PTXi/Nrf2Ht7'<l  fl225) 

G0HH0N/ZMTX2/ZH 211225) 

COMMON/DSNMTX/N tf DM, NOOV ,HOEY , DM  C175 ‘ ) 
C0MH0N/CMrMTX/NYCN,NEHCN,N0DC,CM(225) 

COMMON /TP UMTX/NVTM,TH<i725) 
COMHON/CONTROL/NtfCTL,CTLf90>') 
C0MM0N/CREGPZ/NVRPI*RPZ 1575) 
C0NM0N/CCGT/NVCGT,CGT(4CC) 

COM MON /CK F/NV FC T , FL T C 69 : ) 

NOIM=*»fl'' 

NVSM=2125 

NVZM*a225 

NV0M=l75f 

NVCM=225 

NVTM=x725 

NVCTt*9tt 

NYRPIS575 

NVCGT=4:C 

NVPlTs69< 

<IN=5 

KSAVt*25 

KrATAs5^ 

KPL0T*99 
•CLlSTsie 
KTEPM=6 
CALL  CGTXO 
STOP 
C  END  MAIN 
END 
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SUBROUTINE  OSND(ND) 

OliENSION  NO(i) 

Nociise 

N0(2)s2 

NOf  3)s2 

N!D(U»a7 

NOfSIsO 

NDC6»=1 

Nn{7»=') 

RETU9N 

C  END  SUBROUTINE  DSND 
END 


SUBROUTINE  OSNM ( A « B *  £ Xf G«Q« C» OY* EY , H,HN « R«AN, GN*ON> 
OIHENSION  A(8  .3  I  tBiatZ)  tCf2*e)«Gf  8)  tOY(2»<.l  «H(3t8)  «R{3* 
DATA  GRAVTY.0£GTR0,PI/32.i74,.ClTC5J29,5.i.4l5927/ 

CALL  ACOATA(LEVEL«VTt ALT, ALPHA »ZA,ZAO«ZO»ZU*ZDE«ZOF« 

1  PHA,PMAO,PMQ ,PMU,PMD£,PHOF, XA,XAL,XQ,XU,XO£,XDF, 

2  TE,OLX,BSPAN) 

If  ALPHARa3EGTR0*ALPHA 
U' aYT«COS<ALPHAR) 

W-*YT*SIN(ALPHAo» 

Ad,-!)*!. 

A  1 2 ,1 1  s-GPAv/TY*  SIN(  ALPHAR)  /VI 

A(2,2)aZA 

ACZfTIsl.+ZQ 

AC!,2I=PPA 

AI?,7l=PMn 

A(2,7) ^ZA 

AC2,8)=ZO 

An,7)sPHA 

A<1,8»=PM0 

A(2,«t»sZ0E 

AI2,5)=ZnF 

A»3,4)=PHCE 

A<  3,5>=PM0F 

A<4,4I=-TE 

A<5,9)=-Tf 

B(4,l»aTE 

e(5,2»aTE 

CALL  GUSTStLEVELf ALT, SLU,SLH,SIGU, SIGN) 

A(6,6)a.VT/SLH 

A{7,6l«Cl,-SQRTI3.n*SIGW*S0RTC-Af6,6)  >/SLH 
A(7,7}aA<G,6) 

AC8,8»*-VT*PI/4./BSPAN 
A(8,6)a-A(8,6I»A (7,6) 

A(8,7)s-A(8,e)»A(7,7) 
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GC7»*SIGH*SQRTr3.*VT/SLM»/¥T 

G(8ls-A<6,8l*6(7l 

0*1. 

C(2,2)*-l. 

Hll.llal. 

H(2,2)*l. 

H(3,3lal. 

H<2,7»sl, 

Rfl.l)ai‘.76E-6 

R<2.2|al.22£-5 

R<3,3|a3.22E-5 

RtfrURN 

C  rHO  SUBnOUTINE  OSNH 
ENO 


SUBROUTINE  TRTHOfNOI 

OIHENSION  NOdI 

N0Cl)a9 

N0(2)s2 

Nn<3»a3 

NOU)*! 

RETURN 

C  END  SUBROUTINE  TRTHO 
ENO 


SUBROUTINE  TRTHM ( 4T , BT, GT. QT , HT, RT. TDT , TNT) 

OIHENSICN  AT<9.9I »BTC9»2I»GT{9) »HT<3,9) ,RT(?,3» ,TDT(8.9) 
DATA  GRAVTy,0EGTRD»PI/72.l74..31745'!29i3..ti5927/ 

CALL  ACC ATA (LEVEL tVT, ALT, ALPHA. ZA,Z AD, ZC.ZUfZCE.ZOF, 

1  pma,phao,pho,pmu,phoe,phof,xa,xad,xq,xu,xde, xof, 

2  TE,OLX,BSPAN) 

1"  ALPHARsQEGTRO^ALPHA 
U'>*VT*C0S(ALPHAR) 

H^aVT^SINIALPHAR) 

RZAOsl./ll.-ZAD) 

A'T  (i,3)*l. 

ATC2,i)*-GRAVTY*SIN{ALPHAR)/UP 

AT(2,2»*ZA 

AT(2,3»*1.^Z0 

AT(2,4)*ZU 
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AT(3t2l=PHA 
ATC3,3»=PMQ 
AT  I3»1*>*PMU 

AT  «»tl |s-GRAVTY*COS  CALPHARI 

AT(4,2>=XA 

AT(4,3I*X0-HC 

ATC4»4)*XU 

AT(2t5)=70£ 

AT(2,6»*Z0F 

AT(3,5)sPM0E 

AT(3,6|sPK0F 

AT  C4»5»  =  X0E 

ATC4,6IsX0F 

AT(5,5>=-TE 

AT(6i6)s-T£ 

ATf2,8)=ZA 

ATI2,9I=Z0 

ATC3t6l=PMA 

A’d.qisPMQ 

AT(4,e»=XA 

AT<4,9l=yQ 

CALL  GUSTS(LEV£L,ALT,SLU,SLM.SIGU,SI6W) 
A''(7,7»  =  -VT/SLW 

ATI8,7)=C1.«SQRT(T. 1) •SIGW*S0PT (-AT (7 »7 » » /SLW 
ATC8,aiaAT(7,7» 

A’’(9,9)a-y/T*PI/4,/BSPAN 
AT<9,7|s-AT(9,9l*AT (8,7) 
AT(9,8la-AT(9,9)*AT(e,d) 

GT(7|al, 

6T(8)=SIGW*SQRT(3.*VT/SLW)/VT 

G''<9l=-AT(9f9)*GT(8) 

QT=1. 

DO  2"  1=1,9 

A‘'(2,I)  =  AT(2,I)*RZA0 

A^(7,I)=AT(3,I)+P^AO*AT(2,I) 

AT  14, 11  =  A T (4, II  ♦X AD* AT (2, 1) 

3T(5,1»=^E 

8T(6,2)=Tr 

HT(i,ll=l. 

HT(2,2I=1, 

HT(3,3)=1* 

HT(2,8I=1, 

RT(i,ll=4,76E-6 
RT(2,2»=i.22E-5 
RT(3,3l=5.22E-5 
TDT(i,llf  =  l. 

TOT  (2, 21  =  1. 

T0T(5,3I*1. 

TnT(4,5l«l. 

T0T(5,6)=1. 

TOT  (6,71*1. 


T0T|T.8)»1« 

T0T(8*9)«1. 

R'TURN 

C  END  SUBROUTINE  TRTHM 
END 


SUBROUTINE  ACOATA (LEVEL* VT, ALT* ALPH a ,Z A , ZAD, ZQ • ZU ,ZO£« ZOF, 

1  PHA*PHAr*PH0,P*1U,PMDE.PNDF,)(A,XA0.)(0»XU*X0E*XDF, 

2  TE.DLX,BSPAN) 

COMMON/FILES/KSAVE»KOATA*KPi.OT*<tIST»KT£RN 
data  NENTET/l/ 

5  MOITF  Vl 

READ*, LEVEL 

IF(  (LEVEL.GT.31  .OR.  (LEVEL.LT.in  GO  TO  5 
W=ITE  1:2 

R'AO^tVT, ALT*ALPHA 
H=^ITE  I*?? 

R£AO*,ZA,ZAQ,ZQ,ZU,ZDE.ZDF 
WRITE  lit 

READ*,FMA,PHAO,Ot1Q,PHU.PHOE*PHDF 
W^ITE  It  5 

RiAO*, XA, XAO*XQ*XU, XOE*XDF 
M=ITE(KLIST*1TI) 

HRITE(KLIST,1“.9)  LEVEL 
WRITEIKLIST,1?2) 

MRITE(KLIET,115)  VT, ALT, ALPHA 
WRITE(KLIST,133I 

WRITE (KLI FT, 113)  ZA,ZAD,ZQ,ZU.Z0E.ZDF 
W«:ITE(KLIST,134) 

WRITE (KLI ST, llT )  PMA , PMAO ,PMO ,pmU, PMDZ , PMOF 
WR1TE(KLIST,135) 

WRITECKLIST,11C )  XA ,XAD,XQ,XU,XnE,XOF 
IF(NENTRY.EQ,  S)  GO  TO 
eSPAN=3-  . 

DLX=13.798 
TE  =  2:. 

RETURN 
WRITE  1'6 
READ*,TE 
W?ITE  1:7 
REAO**OLX 

WRITE  ire 

READ*,9SPAN 

151  FORHATC*  FNTER  TURBULENCE  LEVEL  Cl*2,3)  >") 

1:2  FORMAT <"  ENTER  TRIM  VELOCITY*  ALTITUDE,  AND  ALPHA  >") 

1(3  FCRMATC"  ENTER  ZA ,  ZAC,  ZQ*  ZU*  ZDE,  ZDF  >") 

1?4  FORMAT  (••  ENTER  MA,  MAD,  NQ*  MU,  MOE ,  MQF  >“) 


172 


irs 
!»'  6 
1C7 
iDe 

l»»g 

11? 

C  END 


FORMAT*"  ENTER  XA,  XAOt  XQ,  XU,  XOE,  XOF  >"l 
FORMAT («  ENTER  TIME  CONSTANT  FOR  ELEVATOR  >") 
FORMAT*"  ENTER  DISTANCE  FROM  CG  TO  ACCElEkOMETER  >"» 
FORMAT*"  ENTER  MING  SPAN  >") 

FORMAT(6X,Il) 

FORMAT  *6  *  6XlPEl5,7n 
RETURN 

SUBROUTINE  ACOATA 
END 


SUBROUTINE  GUSTS *LcVEL .ALT, SLU, SL W, SIGU, SIGN) 

DIM-NSICN  ATRB1*4I,ATPB?*4),ATRB3*4)  ,SlGTl*4l  ,SIGT2*  4)  ,  SIGT3  *«,) 
DATA  AT081/2Lra.,275”.,lU.’:»  ..SOSIC./ 

DATA  ATeB2/2tju.,2T5.:.,lw33“.,45:-.r:./ 

DATA  ATRB3/2l3i:.,5i)0C.,2a0Cw.,7tfCUu./. 

DATA  SIGTl/4.5,5. 

DATA  SIGT2/e.5,l!i..lw.,f./ 

DATA  SIGT'/12.,21.,2j...*./ 

DATA  ITl, IT2,IT3/1,1,1/ 

IP*ALT-175fc,»  5,i5,15 
5  IF*ALT-l,.wj,)  9,i;,lv 

a  ALTTsALT 

GO  TO  12 
1"  ALTTslJft. 

12  SIGHS?. 5*FL0AT*L£V£l) 

SIGU=1./*  .177+8.23£-4^ALTT»**.4 
SLHsALTT 

SLU=ALTT*SIGU**3 
SIGU=SIGU*SIGH 
GO  TO  I*?? 

15  SLU=175r. 

SLHS175C  . 

IF*lEVEL-2»  17,18,16 

16  CALL  T8LUP1<ATRB3,SIGT3,4,IT3,ALT,SIGU) 

GO  TO  19 

17  CALL  T3LUri*ATRBl,SIGTl,4,ITl,ALT,SIGU) 

GO  TO  19 

18  CALL  TBLUF1*ATRB2,SIGT2,4,IT2,ALT,SIGU) 

19  SIGHsSIGU 
Iw?  RETURN 

C  END  SUBROUTINE  GUSTS 
ENO 
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SU9«0UTINE  TBLUPIIX •Y.Nf IXP«  XP,YP> 

OIH&NSION  Xfll,Y(il 
IFIIXP)  lE.lStl 
1  ir<IXP-N)  10.10,5 

5  IXP*N 

GO  TO  18 

i:  IF(XP-X(IXPn  12,18,2r 

12  lXPsIxP-1 

IFCIXPI  15,15, 1'i 
15  IXP=1 
18  YOsYlIXPI 
R^TU^N 

2’'  IF(IXP-NI  21,18,5 

21  IXPP1*IXP+1 

22  IFIXe-XdXPPi  M  25,3C,3' 

25  Vo=Y(IXO} 4 fXP-Xf IXP}|/(Xf IXPPl)-X(IXP) ) «(y|IXPPl>-Y(IXP) I 

RfTUPN 
IXPsIXPPl 
GO  TO  2^ 

C  TND  SUBROUTINf  TBLUOl 
ENO 
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SUBROUTINF  CGTXQ 
C0HH0N/HAIN1/N3IH«N0IM1,C0H1 (1) 

C0MM0N/MAIN2/C0H2<1> 

COMMON/INOU/KlNtKOUT,KPUNCH 

COHHON/OF SIGN/NVC0H,TSAHP,LFLRPItLFLCGT,LFLKF,LTFVALfLA30RT 
COHMON/FILtS/<SAV£,KOaTA,KPLOT.<LIST,KT£RM 
COMMON/SVSPTX/NVSi.SMIll 
CO?iMOt4/ZMTXl/NVZM»ZMl  (1> 

COIMON/ZMTXZ/ZiZdl 

CONMON/NOlMO/NNO«N90fNPO*NHO«N03*NMOtNMOOfNPLOtNHPNWOtNNPR 

COHMON/LOCO/LAP«LGP«LPHI*L3C«LEX«LPHOtLQ»LON,LQO«LG«LOY,L£Y,LHP,LR 

COHMON/OSNt1TX/Ny/OM,NOOY,NOEY,DMCl) 

COMMON /NO IMG/ NNC,NPC*NPC 
C0MM0N/L0CC/LOHC.L30CfLCCtLCC 
COMMON/C»'DMTX/NVCM,NE  WCM,  NOOC  »CM  { a.) 

C3MM0N/NniMT/NNT,NeT*NHT,NMT 

CONHON/LOCT/LPHT,lBOT, LOOT, LHT, LPT tLTDT, LINT 
COMMON/TKUMTX/N\/TM,TMCll 

COHMON/LCNTRL/LPIil ,LFI12 t LPI21 t LPI22 ♦ LPHuL t LBDL 
COtiMON/CONTROL/NVCTL,CTLCll 
Cn!*MON/LFrGPI/LXOW,LUOW,LPHCLtLKX,LKZ 
C^MMON/CRFGPI/NVRPItRPICl) 

COMrtCN/LCGT/LAll,LA13,LA21,LA23,LA12,LA22,L<XAii,L<XAl2,LKXA13 

COMMON/CCGT^NYCGT.OGTd) 

COMMCN/wKF/LFADSNtLFLTRK.LFCOV 
CnMMON/CKF/NVFLT,FLT<ll 
DIMENSION  LOd5)  ,NOd'  ) 

DATA  NPLTZM/6m5/ 

DATA  lEOI  ,NO/-i»lHN/ 

REMIND  KLIST 

WPITE(KLIST,115)  OATE ( OUM) » TI ME ( OUM ) 

HSITE<KTERM,115I  OATE tOLH» , TIFE C OUM ) 

IIF  FORMAT  *  •  CGTPIF  *  ♦  *“714X, 

1  ••PROGRAM  TO  DESIGN  A  COMMAND  GENERATOR  TnACKER-/e  X» 

2  ••USING  A  PEGULATOR  WITH  PROPORTIONAL  PLUS  INTEGRAL  CONTRCL**/l6X, 

3  ••AND  A  KALMAN  FILTER  FOR  STATE  ESTIMATION.  ••/25X, 

U  ••♦  ♦  ♦  CGTPIF  ♦  ♦  ♦••//liX,-DATE  I  ••»A1 

5  ••TIME  I  ••,A1j////) 

REWIND  KSAVE 
REMIND  KCATA 

MRITECKSAVE,112)  lEOItNPLTZM 

00  1?  1*1,1' 

1?  NP(I)*n 

DO  12  1*1,15 
12  LD(I)*1 

LFLRPI*" 

LFLCGT=G 

LFLKFsfl 

LTEVAL*r 

LABOR!*? 

IPI** 
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ICGTsC 

ITRUs*^ 

1FLTR*9 

NVCOHsHiNC  CNOIH,NtfZM) 

K0UT*KL1ST 

KPUNCH*KPLOT 

IF(NVSH.GE.NPLT2H)  GO  TO  5? 

MPITE  iri,NPLTZH 
GO  TO  itec 
H^-ITE  1C  2 
R- AO*.TSflMP 

if(tsamp.le.c.)  go  to  5" 

MflIT£!KLlST,l03)  TSAMP 

FORMAT  rv  SAMPLE  PERIOD  IS  ••.F5.3,“  SECONDS**) 

CALL  SETUPIN0,LD,ICGT,ITRU,1) 

IFCLAdOfiT)  It.ti  .iL-SirC' 

LABOPTst 
WRITE  I"!* 

FORMAT  r*i  CONTROLLER  DESIGN  CY  OR  N)  »**) 

READ  111, IANS 
IPflANS.EQ.NO)  GO  TO  SSf 
LFL<F=a 

CALL  PIMTXdPIl 
IF(LA30RTI  lCj3, 125,1': 

H-ITE  1»5 

FORMAT  (••■^DESIGN  R£G/PI  lY  OR  N)  >**) 

REAO  111, IANS 
IFdAKS.EQ.NO)  GO  TO  ISf 
CALL  SRcGPI 

IF(LABORT)  lCai,2kL,lCtt* 

w°iTE  re 

FORMAT  DESIGN  CGT  CY  OR  N>  >**) 

READ  111, IANS 
IF(IA^S.EO.NO)  GO  TO  i'' 

CALL  SETUP(ND,L0,ICGT,ITRU,2) 

IFCICGT)  I55,lj«.-,i55 
IFCLA30RTI  inT,l6J,li/Lr 
CALL  SCGT 

IFCLABORT)  if  170,  ItoO 
IFILPLCGT.LE,1)  GO  TO  125 
L ABORT*; 
w^iTE  r? 

FORMAT  (**I  CONTROLLER  EVALUATION  MRT  TRUTH  MODEL  OR  Nl 
READ  111, IANS 
IF(IAKS*E0.N0)  go  TO  25' 

CALL  SETUPCN0,L0,ICGT,ITRU,3) 

IFCLABORT)  20^ ,  26*. ,  10 3'; 

LTEVAL*** 

CALL  CEVAL 
60  TO  1(  i 
L ABORT*: 


HPiTE  r  e 

ll^e  format  FILTER  DESIGN  (T  OR  N)  >-) 

R^AO  111, IANS 
IFflAKS.EQ.NOI  GO  TO  9fi" 

CALL  FLTRKfIFLTRI 
IFUFLTR.EQ.tl  60  TO  9fl:. 

IF{LABORTI  lC?C,51<!,l?Crj 
Sir  CALL  S£TUP(N0,L0,ICGT,1TRU,3) 

IF(LA30RT)  59J,525,igLv 
S2S  CALL  FEVAL 
IF(LAeORT) 

9-1  M»ITE  r9 

I'^R  FORMAT  (TtNO  DESIGN  RUNS  lY  OR  N»  >") 

RHAO  ill, IANS 
I^-dAKS.EO.NOI  GO  TO  IL" 

IFILPLRPI.EQ.i;)  GO  TO  ISSC 

NPNTS= NRO’NNPR 

Na(l>=NPNTS 

NO(?l=LKX 

N0C3)=L<7 

CALL  HFILP0C4,NPNTS,NC,RPICLKX)) 

WPITI  113 
ICl  ■*  CONTINUE 

HRIT£<KLIST,11'J» 

R-;wiN0  ksave 
REHINO  KCATA 
RIHINC  KLIST 
MPITi  Ilf 

1"1  FORMAT (~t INSUFFICIENT  MEMORY  /SYSMTX/,  NEtDI  ",I4) 
irZ  FORMAT  ("(.ENTER  SAMPLE  PERIOD  FOR  DIGITAL  CONTROLLER  >“» 
Ilf  FORMAT  CT  PROGRAM  EXECUTION  STOP”) 

111  F0RMATCA7) 

112  FORMAT (214) 

113  FORMAT (EX, "REG/PI  GAINS  WRITTEN  TO  'SAYE*  FILE") 

RETURN 

C  END  SUBROUTINE  CGTXO 
END 
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SUBROUTINE  SETUP<N3,L0»ICGT»ITRU«ITYPE) 
DIMENSION  NOdIfLOfll 
IFCITVPE-21  lU,i5f23 
iC  call  S0SN(N0,L0) 

RETURN 

IB  CALL  SCMO(NOtLOtICGTI 
RETUPM 

CALL  STRTH(NOtLOtlTRU) 

RETURN 

C  END  SUBROUTINE  SETUP 
END 


SUBROUTINE  SGSN(NOtLO) 

COMMON/CFSIGN/NVCOM,TSAMP,LFLRPIfLFLCGT,LFLt<F,LTEVALiL  ABORT 

COHMON/SYSMTX/NVSM^SMCll 

COHMON/ZMTKl/NYZM.ZHl (il 

CONMON/ZHTX2/ZM2(ll 

COHNON/NOIMO/NNO«NRO«NPOtNMD»NOD«NMOtNWCO»NPLO.NMpNMD*NNPF. 
DIMENSION  NOdI  tLOd) 

NSIZE=tJ 

CALL  RSYSISM,L0*N3,1,NSI7E) 

1FCLA80RT.GT*0)  RETURN 
NSIZEsNNPR 

IFtNPLO.GT.NSIZE)  NSIZ£=NPLD 
NSIZEsNSI7E*NSIZE 
I^(NSIZ£.LE«NVCON)  GO  TO  5 
HRITE  i:i,NSIZE 

i’l  FORMAT  CMNSUFFICIENT  MEMORY  /MAINlX,/*1AlN2^t/ZMTXl/,/ZMTX2/,  NEED 
1*  ~,I4» 

LABORT=NSIZE 

RETURN 

5  IFCNRO.EQ.NPD)  GO  TO  13 
W=ITE  if  2 

1'’2  FORMATC’C  NUMBER  OF  INPUTS  AND  OUTPUTS  MUST  BE  EQUAL  FOR  DESIGN"! 
LABORTs-l 
R-TUFN 

IS  CALL  OSCRTOfLDf ZM1«7M2) 

RETU«?N 

C  END  SUBROUTINE  SOSN 
END 


SUBROUTINE  t)SCRTO(LO,ZHitZN2l 
COHHON/NAINl/NDIHtNOIHi,COHi(i) 

COHNCN/OESZGN/NVCOH,TSANP,LFLRPItLFLCGTtLFLKF,LTEtfALtL4BORT 

COHHON/FILES/KSAVEtKOATA,KPLOT*KLZST,KTCRH 

COHHON/SVSHTX/NVSNfSMCil 

CONHON/NOIMO/NNO«NRO«NPO«NNOfNOO»NHOtNHOD»NPLDtNUPNWOtNNPR 

COHMON/LOCO/LAP,LGP,LPHI,LBO*LEX,LPHO,LQ.LaN,LQO,LC*LOY,L£Y,LHP,LR 

C9HNON/OSNHTX/Ny/DH,NOOY,NOEY«DHC1) 

CONHCN/t.KF/LEAOSN«LFLTRK«LFCCV 

COHHON/CKF/NYFLT,FLT(ll 

OliENSION  LO(l) »ZH1(1},ZN2(11 

NOIMsNPLC 

NaiMl*NOIM»l 

CaUL  POL£SISN«NNDtl tZHl,?H2> 

00  1  Isl«NNO 

IFfZMlCI*  .GT.<5.)  LFLCGTa-1 
CALL  TFRHTXISM.OMfNNOtNNO.Z) 

LftP=l 

LGPsLAP4-NPL0*NPL0 
IFINWO.EO.w)  GO  TO  5 

CALL  TFPMTX<SM(L0(4n  «OM(LGP|  ,NND»NWD,2) 

IF(NCD.EQ.C)  GO  TO  It 
LlsLAOCR(NPLD,NNO+l.l» 

L2»LA00RCNPL0.1.NNC!+i  I 
LTsLAOOR*  NPLDtNNO+l,NNO*l» 

CALL  ZPAPT{0M{L1» fNOO*NNOtNPLO> 

call  TFRMTX(SiaO<1l  I  ,DFCL2I  tNN0,NDD,2) 

CALL  TFRKTXfSMCLOdZI  l,CiHL3i  ♦N00»N0D»2» 

IF(NWO,cO,^l  GO  TO  8 
L1=L1*LGP-1 

CALL  ZPARTIOMCLl) ,NDO,NWD,NPLD) 

L2=LA00P(NPL0»1 »NWC*1»+LGP-1 
L2=LA0DR<NPLC,NN0+1,NW0+1I*L6P-1 
CALL  ZPARTfOMILZ) ♦NND,NHDD,NPLD> 

CALL  TFRHTK(SH<L0<13) I,ON(L3>,NOD,NWOD«2) 

LFHIsLGP+NPLO*NHPNWD 

LT4DSN=t 

CALL  NCSCFT(Oi,NOIH,NTl 

CALL  OSCRTCNPLDf 0M,TSAMP,FLT,Z«1»NT) 

LFLTRKsLEADSN*NPLO*NPLO 

CALL  TFRHTX<0H(LPHII ,FLT,NND, NNO.l) 

L80=LPHI*NN0*NND 

CALL  TFRMTXCSrttZMltNNDfNNO.l) 

CALL  FHNUL  fSN«SM(L0 12  1 1  tNNO*  NNO«  NRO«  OM(LBO) ) 

LFX*LBO+NND*NRD 
IFCNOO.EO.ai  GO  TO  i5 
L1>LA00R  (  NPL0«^t  NN04-1 ) 

CALl.  TFPMTXIOMILEX)  •FLT(Ll}«NNDfNOO«l) 

LPHO=LEX*NNO*NOD 

Ll*LACDRCNPLD.NND«'ltNNO*i» 

CALL  TFRMTXCDHCLPHD) .FLTCLl) ,NOO,NDO,1» 
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LQ*LPHO+NCO*NDO 
GO  TO  2L- 
15  LQ*LEX 

2D  zn NWO.EQ.l')  60  TO  25 

CALL  FTMTX(SN(L0(5> I •ONfLQI •NMO«NWO) 

LQNsLQ«NHO*NMO 
60  TO  28 
25  LONsLO 

28  IF(NH00.E0«6)  GO  TO  33 

CALL  FTH'i'y(SM(L0(i4n  «OHfLQN)«NMDOtNMOO) 

LOOsLON«^NHCO*NUOO 
GO  TO  35 
33  LODsLQN 

IFINWPNHD.6T.4l  GO  TO  35 

LCaLQO 

GO  TO  36 

35  GALL  QOSCFTION(LO}«OMtLQN}«ZHl*ZM£) 

LC*LOO+NPLO*NPLO 

36  LOYsLC+NPD*NNO 
L£Y=L0Y4>NPC*NRD 
LHP=LPY*NPC*NOO 
LRsLHF*NMC*NPLO 
L1=LR+NHC*NMD-LC 

CALL  FTMTXCSMaO<6n,OH(LCItLl.l) 

LlsLtY-l 

NOOtsl 

DO  4'.  IsLDY.Ll 
IP<OM(II  .  tO.a.l  GO  TO  4'' 

N00Y='5 
GO  TO  45 
4^  CONTINUE 
45  NOEYsl 

IF(NOO.LT.l)  GO  TO  55 
Ll=LHP-l 
00  5C  I=LFY,L1 
IF(OMfl)  .EO.O.)  GO  TO  5' 

NOEYs*! 

GO  TO  55 
5^  CONTINUE 

55  CALL  MATLSTC0N<LPHII,NNC.NND."PHI",KLIST) 

CALL  MATLST<0M(L30I,NN0.NR0."BD“,KLIST» 

IF(NWPNWD.GT.5)  call  HATLSTIDKCLODI ,NPLD,NPLO."aD“.KLlST) 
IFCNMD.GT.n  CALL  NATLST(OMCLHP) , NMO,NPlD,~HA~,KLISTI 
IF<NDD.EO.^)  RETURN 

CALL  NATLSTIOKLEXI  , NNO.NDD, "EXO". KLIST ) 

CALL  NATLST(ON(LPHDI ,NDO.NOD»”PHN”,KLIST» 

RETURN 

C  END  SUBROUTINE  OSCRTO 
END 
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SUBROUTINE  QOSCRT(Q«QN»ZNl,ZM2) 

COHHON/HAlNl/NOIH,NOI»«l«COHi  f  it 

connon/oesign/nvcom,tsahp,lflrpi«lflcgt«lflkf,lteval«labort 

COHKON/NDiHO/NNOtNROf NPOtNMDtNOOtNHOfNMOOtNPLOtNHPNHOtNNPR 
COHrtON/tOCO/LAP«LGPtLPHl«LBO*LEX,LPHDtLQ«i.QN*LQO*LC»LOYtLEY«LHPfLR 
COHHON/OSNHTX/NtfOK, NOOY,NO£YtCH(l) 

OIHENSION  QdltQNdl  tZHltl)  •ZHZCl) 

IFINWQ.EQ.D  GO  TO  5 

CALL  TFRHTX(Q«ZM1,NH0«NM0»2) 

5  IF(NWOO.EQ«a)  GO  TO  !<? 

LlsLADOPf  NPL0.NMDd«NW3*l) 

CALL  TFRMTX(QN*ZHl(Ll) •NW00»NM30t2> 

IF(NHD,EO.&)  60  TO  I*! 

L1=LA00R  (KPLO«ifNNO«-ll 

CALL  ZPART<ZMlCLlltNW3.NWD0,NPL0> 

LlsLADDR(NPLO,NWO+id> 

CALL  ZPART(ZM1CL1I,NWD0*NM0,NPLD) 
li*  call  MAT’ (NPLC.NMPNMDtONILGP)  .Z*11,ZM2) 

CALL  INTEG(NPL3,0MCLAF) ,ZM2,DMILQD» .TSAMP) 

RTTU^N 

C  END  SUBROUTINE  OOSCRT 
ENO 


SUBROUTINE  SCMQ C NO, LD t ICGT) 

COHMCN/DESIGN/NVCOM, TSAMP, LFLRPI,LFlCGT,LFLKF,LTEVAL*L abort 
CONMON/FILES/KSAVE,KOATA,KPLOT,KLIST,KTERM 
COMMON/SYSMTX/NVSM.SMCll 
C0MM0N/ZM'*’X1/NVZM,ZM1  (1» 

C0MM0N/ZHTX2/ZM2dl 

C0MM0N/NDIM0/NNC,NP0,NP0,NM0,NDD,NH0,NWD3,NOL0,NMPNWD,NNPP 
C3MM0N/NDIMC/NNC,NRC»NPC 
C3MMCN/CMDMTXZNVCM,NEHCM,N00C,CM  d> 

COMMON /LREGPI/LXDM,LUDW,LPHCL,L<X,LKZ 
COMMON/CPEGPI/NVRPI,RPId» 

OIHENSION  NOdl  ,LOd) 

DATA  NO/IHN/ 

H!fITE(KLIST,ll?) 

Hi  FORMAT!// //IIX, 5  "»,"C6T  DESIGN**, 5("  ♦••|////» 

NEWCMSrf 

IFCLFuRPl)  li.,5,1" 

5  H^ITE  I'-Z 

READ  ill, IANS 
IF(IANS.EO.NO)  GO  TO  9 
CALL  READFS(SM,N0,4,IERR» 

NSZZE>NOd) 

L<X*N0C2) 

L<ZsN0(3» 
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CALL  FTHTX(SH«RPZ(LKX},NSIZL*1) 

IF|IERR.NE.«»  RETURN 

CALL  MATLST(RPI(L<XI ♦NRC. NNO,“KX",KLIST) 

CALL  MATlST(RPI(L<Z1,NR0.NR0.-KZ-,<LIST> 

LPLRPI*-! 

GO  TO  1? 

8  IFfLFLCGT.Gc.c^)  GO  TO  9 
WRITE  1*'3 

i'S  FORMAT  (~r  SYSTEM  UNSTABLE  -  -  OPEN-LOOP  CGT  NOT  FEASIBuE**) 

RETURN 

9  LKX=1 
LK2=1 

NSIZE* NRC*NNO 

CALL  ZPAPTIRPKLKX)  ,1,NSIZE*1» 
m  IPdCGT.EO.Cl  GO  TO  12 
WRITE  1-8 

ire  FORMAT  modify  command  model  CY  or  N)  >••) 
read  111, IANS 
IF(IANS.EQ.NO)  RETURN 
12  CALL  RSYS(SM,L0,ND,2,ICGT) 

IFItAPCRT.NE.?!  RETURN 
NEWCMsl 

CALU  P0LESfSM,NNC,2»ZMl,ZM2l 

IP(NPC,£O.NPO)  GO  TO  15 

WRITE  1*!A 

LA90RTS-1 

RETURN 

15  CALL  DSCPTC(LO,ZMi) 

If  2  FORMAT!”  READ  REG/PI  GAINS  FROM  'DATA*  FltE  CY  OR  N>  >“» 
l-U  FORMAT C"r COMMAND  AND  DESIGN  MODEL  OUTPUTS  NOT  EQUAL  IN  NUMBER”! 
Ill  FORMATCATI 
RETURN 

C  END  SUBROUTINE  SCMO 
END 


SUBROUTINE  OSCRTC (LOtZNlI 
COHNON/HAZNl/NDlHtNOIHl,COHlll) 

COMHON/DESIGN/NVCOM,TSAMP,LPLRPI,LFLCGT,LFLKF.LTEVAL#LABORT 

COHHON/FILES/KSAWE,KOATA«KPLOTt<LlST,KTERH 

CONNON/SY  SHTX/N VSNtSM  Cl) 

COMMON/NDIMC/NNC«NRC«NPC 

COHNON/LOCC/LPHC«LBOC«LCC«LOC 

CONMON/CHOMTX/NVCM,NEWCM,NOOC»CH(i) 

DIMENSION  LD(t)fZMl(l) 

NOIHsNNC 

NDIMlrNDIMU 

CALL  NOSCPT(SH,NOIM,NTI 

CALL  DSCPTfNOIH«SM,TSAHP»CH»ZMl»NT) 

LPHCal 

LBOCsLOHC+NNC*NNC 

CALL  MNUL(ZMl,SMILOI2)l*NOlH,NOIM,NRCtCMC^BCC» ) 

LCC=LBOC+NNC*NRC 

LDC=LCC^NPC*NNC 

L1=LDC+NPC»NRC-LCC 

call  FTMTXISMfLOO)  »*CHILCC»  fLl,l) 

N00C=1 

L1=L1*LCC-1 

00  i:  i=Lrc,Li 

IF(CM(I).E0.t  .1  GO  TO 

Nooc=: 

60  TO  15 
I'*  CONTINUE 

15  CALL  MATLSTiCH,  NNC,NNC,**phM~,KLIST) 

CALL  MATLST<CM{LB0C1 , NNC.NRC f-BOM”, KLI ST) 
call  MATLST<CM(LCCI ,NPC,NNC,"C«"tKLIST) 

CALL  MATLSTICMCLDC)  ♦NFC,NRC»**0M",KLIST) 

R'TURN 

C  END  SUBROUTINE  OSCRTC 
ENO 
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SU9R0UTINf  STRTHINO.LCtITRU) 

COHMON/OE SIGN/NVCOM,TSAHP,LFLRPI«LFLCGT«LFLKF«LTEVALtLABORT 
COHHON/SYSMTX/NVSitSMd) 

C0MM0N/ZMTX1/NV2M.7H1C1I 

C0Ri0N/2MTX2/ZM2Cl» 

COHHON/NOIHO/NNOtNRO«NPO»NHOtNDO«NHO*NWCOtNPLOtNMPNMCtNMPR 
'  COHHON/N01MT/NNT,NRTtKHT,NMT 
OIHENSZON  NO(l)  tLOdI 
data  NO/IHN/ 

IFf  ITRU.EQ.JI  GO  TO  5 
M~ITE  103 

FORMAT  modify  TRUTH  MODEL  (Y  OR  N>  >•*) 

READ  ill, IANS 
111  F0RMAT<A3) 

IFdANS.EQ.NO)  GO  TO  2’ 

5  call  RSVS(SM,L0»N0t3.ITOU) 

IFCLABORT,GT, 01  RETURN 
NSIZE=NNT*^!;JT 

IFCNSIZE.LE.NVCOM)  go  TO  8 
i:*i,NsiZt 

i:i  FORMAT  INSUF^NICItNT  MiHORY  /HAINl/,/ MAIN2/ , /ZMTXl/,/ZMTX2/ ,  NEED 
II  -,I2» 

LABORTsNSIZE 

RETURN 

8  IF((NRT«£O.NRD)«AND.tNMT.EQ.NMO))  GO  TO  1. 

WRITE  1C  2 

1^2  FORMAT C’T  INPUTS  AND  MEASUREMENTS  MUST  BE  EQUAL  IN  NUMBER  FOf  DESIG 
IN  ANO  TRUTH  MODELS**) 

LA30RT=-1 

RETURN 

IH  CALL  P0LESCSM,NNT,3,7M1,ZM2) 

CALL  OSCF.TTILD.ZMl) 

2‘J  L’£VAL=1 
RETUPN 

C  FNO  SUBROUTINE  STRTH 
END 
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SUBROUTINE  OSCRTT{LO*ZHl» 

COHHON/MAINl/NI3IH«NOIHi,COHl(i) 

C0HN0N/0ESIGN/NVC0M,TSAMP*LFLRPItLFLCGT,LFLKF.LTEWAL.LA30RT 

COHNON/SVSHTX/NtfSN«SNIl> 

COHMON/FILES/KSAVE«KOATA«KPL OT,KLISTtKT£RH 

CONMON/NOINC/NNO«NPOtNPOtNHDtNOO*NHQ«NMOO(NPLD«NWPNWO«NNPR 

COHMON/NDINT/NNT,N9T,NHT*NWT 

COHHON/LOCT/LPHT.LBOT*LOCT,LHT*LRTtLTDT,LTNT 

C0HM0N/TFUHTX/NVTH,TH(1I 

OINENSION  L0(1)»2M1C1I 

N3IM=NNT 

NDIH1=N0IH*1 

CALL  NCSCRT(S>1»NOIM,NTI 

CALL  DSORTCNOIN,Sf1,TSAMP,TM,ZMl,NT) 

LPHT=1 

LBOTsLPHT«-NNT*NNT 

CALL  MMUL  «ZM1,SH(L0(2I»  *NDIM,NOIH,NPT»TM(LBOTn 

LOOT=LaOT+K'NT*NRT 

IP(NMT.GT.u1  GO  TO  it 

LHT=LODT 

GO  TO  15 

i;  CALL  NA^-S  (NOIH,NWT,SMCLOI3n  ,SM(LO«4n  ,ZMi> 
call  INTEGCN0IM,SM,ZM1»TH(LQCT|  ,TS  ,MP) 

CHT=LODT-f  NNT^NNT 
15  LRT=LHT+NNT«NNT 
LTOTsLRT+NNT^NNT 
LTNTaLTDT+NNO^NNT 
L1sLTNT*NCD*NNT-LHT 
call  FTMTXISM(L0(5)  ),THILHT)  ,L1,1) 
call  MATLSKTH,  NNT,NNT,"PHT",KLIST> 

CALL  MATLST(TM(L80T»  ,NNT,NRT,"SDT*’,KLIST) 

IFCNWT,GT.C»  call  MATLSTITHILQDT) ,NNT,NNT,-Q0T-,KLI3T) 
RETURN 

C  END  SUBROUTINE  OSORTT 
END 
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SUBROUTINE  PIHTXCIPII 
CONHON/HAlNl/NOIHtNOIHltCONKl) 

C0HH0N/DESIGN/NVC0H,TSAMP,LFLRPI,LFLCGT,LFLKF,LTEVAL.LA30RT 
CONHON/FlLES/KSAVEtKOATA,KPLOT(KLIST«KT£RN 
CONHON/ZMTXi/NVZHtZMl (i» 

C0HH0N/ZMTX2/ZH2(1) 

C0NN0N/NCIN0/NN0tNR0«NP0*NN0«N00«NMDtNW30tNPi.0»NMPNW0f  NNPR 
COHHON/LOCD/LAP«LGP,LPHI,tBO«LEX,LPHO«LQtLQN(LQOtLC«LOV,LeYfLHP,LR 

cohhon/osni<tx/nwoh,nocy,noey,omii» 

C0MHCN/LCNTRL/LPIll«LPIl£,LPZ21*LPIZZtLPH0LtL60L 

C0NM0N/C0NTR01./N\/CTL«CTL(1) 

IF«IPI,tQ,ll  RETURN 
HRIT?(KLl?T,liei 

11;  FORMAT  (/Z//11X, 5  (•••  "I  , “CONTROLLER  S£T-UP“,5C*  ***1////) 

NniH=NNPR 

N?IZ£  =  N0IP*I2*NDIM*NP0) 

IF(NSIZ£.L£.NVCTLI  GO  TO  IT 
WRITE  l?i,NSIZE 

1*1  FORMAT  IT  INSUFFICIENT  MEMORY  /CONTROL/t  NcEDi  “,I4» 

LABORTsNSIZc 

RETURN 

10  NDIMi=NOIM+l 
L®Ill=l 

LPIl£sLPIll+NN3*NN0 
LPI2iaLPll2>NN0*NR0 
LPI2?sL«>I21+NP0*NN0 
L®HOLaLPI 22+NP0*NRD 
CALL  TFRMTX(OM<LPHI) ,ZM1,NN0»NN0»2) 

CALL  SU3I IZMl,NND,NOIM) 

L2=LACDR( N0IM,1,NND+1) 

CALL  TFRMTX(DM(LB3) ♦ZM1(L2»  » NND,NPD»2) 

LT=LA03R<NDIM,NND+lfll 

CALL  TFRMTXCDULCIfZMlILTI  »NPO,NND,?) 

L4=LAOOR<NOIM,NNO»lf NND+1) 

CALL  TFRMTX(CM(L3Y» ,ZM1(L4>*NP0,NRD»2) 

CALL  GWINV(N0IM»NDIM,ZM1,ZM2 .MR,1) 

IFCMF.EO.NOIMI  go  to  15 
MFITE  1^2 
HRITEIKLIST,1J2) 

1'‘2  FORMAT  ("f  PI  MATRIX  IS  RANK  DEFECTIVE") 

15  CALL  MATLSTCZM2,NNP«,NNPR,"PI",KLIST) 

CALL  TFRMTXCCTL ILPIll I ♦ ZM2f NND, NNDt 1) 

CALL  TFRMTXCCTL  CLPI12) t ZMZ CL2) »NNOtNRO#l ) 

CALL  TFRMTXCCTL  CLPI21) »ZM2CL3) ,NPD,NND»1> 

CALL  TFRMTXCCTL CLPI22) fZM2CL4»*NPD,NRD,l) 

CALL  COIF 

IPIsl 

RETURN 

C  END  SUBROUTINE  PIMTX 
END 
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SUBROUTINE  COIF 

COHHON/HAZNX/NOIH.NOiritCOHlCl) 

COHHON/NDIHO/NNOfNROtNPO«NNOtNOOtNMO«NHCOtNPLO*NMPNNOtNNPR 
COHHON /loco/lap  •L6P«LPHl«LB0«LEX,LPH0,L0tt.QNtLQ0«LCtLDY, LEY, LHP, LR 
COHHON/DSNHrX/NVaM,NOOY,NO£V,OM(l) 
C0MH0N/LCNTRL/LPI11,LPI12,LPZ21,LPZ22,LPH0L,LB0L 
COHMON/CONTROL/NVCTl,CTL(1I 
CALL  TFRMTXfOHtLPHIl  ,CTLILPHOL) ,NNC,NND,2) 
Ll*LAOCPfNOlH,l,NNO*l»^LPHOL-l 
.  CALL  TFP.HTXtO'KLBO)  ,CTLlLl},NND,NR0,2) 
L1«LADCRCNQIH,NN0«1,1I4>LPH0L-1 
CALL  ZPAeTICTL(Lll,NRC,NNO,NDIH» 

Ll*LAD0RIN01H,NN0+i,NN0+l» ♦LPHDL-1 
CALL  IDNT(NiiD,CrL(Li)  ,!•) 

LBDLsLPHCL^NOIH^N'JIM 

call  7PARTICTL(LaOL)  ,N.M0,NR0,NDIH) 

Li=LAOCF ( NOZH,NNO>L ,1) ♦LBOL-l 
call  I0NT(NR0,CTL(L1) ,1.) 

RETURN 

C  END  SU3FOUTIN?  CDIF 
END 


S'J3P0UTINE  SRtCPI 
COXMON/HAlNl/NDXH.NOlHltCOHlfl) 

C0HN0N/0ESIGN/NVC0M,TSAHP«LFLRPItLFLCGT,LFLKF,LTPVALtLA90l!T 

COHMON/FlLES/<SAV£,KCATAtKPLOT,KLISTtKT£RH 

CORHON/SYSHTX/NVSr^tSMdl 

COMHON/ZHTXl/NV2»1.ZMl(l» 

COHHON/ZHTX2/ZM2fll 

COHHON/NDIHD/NNOtNROiNPOtNHD,NODtNHD«NHCOtNPLOf NMPNHCtNNPR 

C0MH0N/LCNTRL/LPIll*LPIi2*LPI21,LPI22.LPH£;L*LBDL 

COPHON/CONT«OL/NVCTL»CTL(1I 

COPMON/LREGPI/LXOW,LUOH,LPHCL,LKX,LKZ 

COHHON/CREGPI/NVRPI ,RPI dl 

MoiT£(KLIST,ini 

Ilf  FORMAT  C////11X,  5  “)  ♦“REG/PI  DcSI  GN**,  &  (“  ♦•*»////) 

NSIZE=NR0*(4*NR0*NND» ♦NNPR*NNPR 
IFINSI2£.LE.NVRPI»  GO  TO  5 
HRITE  1^1,NSIZ£ 

lv.'l  FORMAT  (**1  INSUFFICIENT  MEMORY  /CREGPI/,  NE£Dl  ".li*) 

GO  TO  8 

5  NSI7c=NNPF*(3*NNPR+NR0) 

iPfNSIZE.LE.NtfSMl  60  TO  If 
WRITE  i,  2»NSIZE 

ir  2  FORMAT  **T  INSUFFICIENT  MEMORY  /SYSMTX/,  NEEDt  'ME) 

8  La90RT=NSIZE 

RETURN 
1C  LXsl 

LU=LX+NNeR*NNPR 

CALL  HXUSdMfLXI  .SHfLU)  tC0HA»ZMl,7M2) 

luist*lu»nnpf.*nro 

lphp=luist+nnpr*nnpr 

CALL  PXUP  (CTL(LPHOL) ,CTL <LBOL» , SM (LX» , S M (cU) ,C0M1,ZME, 

1  SM<LUISTI«SH(LPHPI  ,SMCLXI  ♦ZHl) 

CALL  0RIC(NDIM,SM(LPHF) ,ZM2,SM(LX)»ZMl,RPi(LPHCL)> 

CALL  GCSTAR<SM(LPHPI ,CTL{LBOL»  tSMCLUl ,ZK1,SH(LUIST) ,SMCLX» ,ZME) 
CALL  TFRMTX(ZMlf SM(LXI ,NR0,NDIM,1) 

CALL  FMMUL<ZM1,CTl(LPI11» ♦NRDtNNO»NND,RPI (L<X) > 
Ll=La00R(NR9,l,NN3+l) 

CALL  FM«UL{ZHl<LlltCTLCLPI21»  tNRO.NRDf NNE,ZM2) 

NOIHsNRD 

N3IMi*NDIPd 

CALL  MA00i«NR0«  NND«  RPI  (LKX)  « ZM2,  RPl  (LKXI  «i..) 

CALL  FKMUL(ZM1,CTL«LPI12) ,NRD»NND ,NRD,RPI CLKZI) 

CALL  F«MUL<ZMl!Lll,CTHLPI22).NR0,NR3,NFDfZM2) 

CALL  MA001(NR0«NR0«RPI(LKZ)«ZM2«RPI (LKZ) tX.) 

CALL  MATLSTIRPI  (LKX  )  ,  NRO,  NNO  t-KX’SKLlST ) 

CALL  MATLSTCRPI CLKX» ,NRO,NND,“KX“,KTERH) 

CALL  MATLSURPICLKZ)  ,NRO,NRD,"KZ~,KLIST> 

CALL  MATLST(RPI(LKZ»,NRD,MRD,“KZ**,KTERM) 

LPLRPI*! 

LFLCGT*f 

RETURN 


C  END 


SUBROUTINE 

ENO 


SREGPI 


SUBROUTINE  HXUS ( X «U«S tZHl, ZH2) 

COHHON/MAlNl/NOIH,NOIf<l»COMl  (1) 

COMMON/DE  SIGN/NVC0f*,TSAMP,LFLRPI.LFLC6T,LFLKF.LTEVAL,L  ABORT 

COHHON/FIL£S/KSAVE.KDATA*KPLOT,KLISTfKTERM 

COHMO*‘'/SVSKTX/NVSM,SN(l> 

COMMON /NDIt'D/NND.NR0,NPC.NHDtND3«NW0»NW  CO  ♦NPLD»NMPNWD»NNPR 

COMHON/LOCO/LAP.LGPfLPHl,LBO*L£X,LPHD,LO,4.QN,LQO,LCtLOY,LEY»LHP,LK  j 

COHMON/OSN«TX/NYOM,NODY,NO£Y»DM(l)  ; 

CCKMr<N/LCNTRL/LPIil,LPIi2,LPI?l  ,LPI??,LPHa.LBDL 

COHFON/CCNTROL/NVCTL.CTLIll 

COMrtON/LPfGPI/LXOW,LUCW,LPHCLtLKX,LKZ 

COMMCN/C«EGPI/NVRPI»FPICll 

DIMENSION  X(l)«U(lt«S(l),ZMl(l) ,7HZ(1) 

DATA  NO/IHN/ 

IFCuFERPI)  5»5,1J 
5  LXDVI=1 

LU0M=IXDM+2*NR0*N?.D 

LPMCLsLUOWfNRO^NRO 

LKXsLPHCL+NNPR*NNPR 

LKZ*EKX»NPC*NNO 

LlsLOHCL-l 

CALL  ZPAP.TfRPI,i,Ll,ll 
ir  LUXsNRO*NRO*l 
WRITE  iri,NPD 

l‘'l  FORMAT!”  ENTER  WEIGHTS  ON  OUTPUT  DEVIATIONS!  ”,I2» 

CALL  ROWGTSfRPI tNPDt*) 

WRITE  l.ZfNRO 

1"2  FORMAT!”  enter  WEIGHTS  ON  CONTROL  MAGNITUDES!  ”,II) 

CALL  ROWGTS!R®I(LUXl,NROfl» 

WRITE  1^3,NRD 

l';3  FORMAT!”  ENTER  WEIGHTS  ON  CONTROL  RATES!  ”,12) 

CALL  RQHGTS!RPI!LUOW),NRO,l) 

CALL  MATLST!RPI,NP0,NPD,"Y",XLIST) 

CALL  DVCTOR!NPO,RPI,ZM1) 

CALL  HATLST!ZM1,NP0,1,”Y”,kTERM> 

CALL  DVCT0R!NR0,RPI«LUXI,ZM1) 

CALL  HATLSTI2M1,NRC,1,"UH”,KTERMI 
CALL  MATLST!R»I!LUXI ,NRD,NRD,”UM“,XLIST) 

NOIMsNNPF. 

NOIMlsNOlM*! 

CALL  FORMX!RPI,RPZ!LUX>,OM!LC),OMILOY) ,ZM2,ZHl,COMi) 

MRIT£!KTEFM,n4) 

l^iL  FORMAT!"!  modify  ELEMENTS  OF  'X*  MATRIX  CY  OR  Nl  >") 

READ  111, IANS 
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Ill  FORMAT (A? I 

irfIAKS«£Q«NO}  GO  TO  29 
WRITE  <KT£RM,  1^51 

1**5  FORMAT!"  LIST  'X*  MATRIX  TO  TERMINAL  CY  Ok  N»  >") 
READ  111* IANS 
IFIIANS.EQ.NO)  GO  TO  12 
CALL  MATLST(ZM2,NN»R,NNPR,"X",KTEF.M) 

12  CALL  ZHATIN!ZH2*MNPR,NMPR,-1) 

2r  CALL  MATLST!2M2*NNPR,NNPR»"X",KLIST) 

CALL  MATLSTIRPI (LUOM>  *NRO,NRD»"UR"*KLIST» 

CALL  OVCTOR(NR9,RP1(LLOW),ZH1) 

CALL  MATLSTCZMl,NRO*l*“UR-,KTERM) 

Tls.25*TSAMP 

CALL  SCALr(ZMi«ZM2*N01M,N01M»Tl) 

CALL  OZAG<NCIM,COM1,CTLClPHOL)  *l*tl*> 

CALL  HAT3A(NCIMyNClH,C0Ml,ZMl,X) 

CALL  MATTACNRO.NOlH.CTLfLSOL) «ZM1*ZH2) 

CALL  rtA^2A<NDIM,N0IH,C0Mi,2Ml,7Ml) 

CALL  HHUL(ZM1*CTL(LB0LI  «N0IH*N0IM  ,N<^D*  S> 

CALL  TFRMTX<RPI CLUOMI ♦ZMlfNRO*NRD,2» 

CALL  MAD01<NP0*NR0*ZH2*ZM1,U,TSAMP) 

RETURN 

C  END  SUBROUTINE  WXUS 
END 


subroutine  F0RMX(0V,RV,C*D*X,Z1*Z2) 

COMMON/NCIMD7NND,NRD,NPO*NMDtND3,NWO*NHCD»NPLO*NWPNHD«NNPR 
OIMENSICN  OV<il  «kY 111 *Cfi>*0!l>  »X(1) *7111) »72fl) 
call  FMMUL(QY,C*NPO*NPO*NNDtZl) 

CALL  FTMUL(C»Z1 ,NP0*NND*NND*Z2) 

CALL  TF«»MtX(Z2*X*NN0*NND*2) 

LlsLADDP(NNPR,NNO+l*NNO*l) 

CALL  TFRMTXCRY,X<LI) *NRO*NRD*2) 

L2»LADaR( NNPR»NN9+1*1 ) 

ifcnooy.eo.o)  go  to  5 

CALL  ZPART<X(L2) *NRD*NNO*NNPR> 

GO  TO  15 

5  CALL  FTMUL(0*Zi *NPO*NPO*NNO*Z2) 

CALL  TFRMTXCZ2*X(L21*NR0,NND*2> 

CALL  FMMUL(QY*0*NP0*NP0*NRD*71) 

CALL  FTKULfO*Zl tNO0*NPD*NRD*Z2) 

Li**) 

00  12  Isl*NRD 

LlsLA00R(NNPR*NN0«l*NN3«I> 

00  12  J«1*NR0 

L1*L141 

L2*L2+1 


X(L1»»X(L1I«Z2(L2I 
12  L1«L14^1 

15  DO  zr  Ial,KNO 

LlaLAOORfNNPR.NNOntll 
L  2  sL  AO  OR  ( NNPR  « I  ,  NNO^l  I 
DO  2w  JaltNRD 
X<L2)aX(Lll 
LlaLl4l 

Z!'  L2aL?*NNPR 
R^TUPN 

C  ENO  SUBROUTINE  FORMX 
END 


SUBROUTINE  PXUP C PHI OL t BOEL.X , U. S, BUIBT, UIST, PHIP.XP, ZMl) 
COiHON/MAlNl/NOIH,N3IMl,COMlfll 

CONMON/NOIHO/NNO«NRO«NPO«NHD«NOO«NHO«NWOC»NPLD*NMPNHCtNNPR 
0IH£N$IQN  PHIQL(l)«30ELCll«Xtl} • U(i) « Sll »  »BUIBT (1 ) ,UIST(1), 
1  PHIPdl  •XP(1I,ZM1(1) 

CALC  GHINVCNRO,NRD,UtZMl,HR,ll 
CALL  HAT3  (N0IH,NR0,B0EL,ZH1,BUIBT) 

CALL  MAT5CZMl,S,NR0,NR0tN0IM,UIST) 

CALL  HMUL (30£L«UZST«N0IH,NR0«N0IHtZMl) 
call  MADDKNDlH^NOlMtPHlOLtZMl.OHIP,-!,) 

CALL  MMU4.<S,UIST,NOIM,NRO#NOIHt7Hl> 
call  MAODl<NOIH,NOlM,X,ZMltXP,-l,) 

RETURN 

C  END  SUBROUTINE  PXU** 

END 
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SUBROUTINe  GCSTARCPHII»«80EL«U«RK«U1ST,GCS,ZH1I 
CONNON/KAlNl/NOIHfNOZKltCONllil 
COHNON/FZLES/KSAV£tKOATA,KPLOT,<LXST,KTcRH 
COMRON/NDIHO/NNO«NRO«NPO»MMOtNOO.NHO,NMCOtNPLOtNMPNMDtNNPR 
OIH'NSXON  PHXPfil •BOEL(ll«Ull),RK(i)«UXST(l)«GCS(l) tZHl(l) 
CALL  MAT3A(NRD,NOIH*eO£L»RKfZMl) 

CALL  HAOOl (NP3«  NRO, ZHlt U«ZN1«1. ) 

CALL  6NZNV(NR3tNRQ,ZNl,U«MRtl) 

CALL  HAT5 (U«B3EL«KR0«NR0«NDIH,ZH1) 

CALL  HATl  (ZHl«RK,KR0tN3lM*N0XH,GCS) 

CALL  HMUL(GCStPHlP,NRCtNOXH,NDIH,ZMl) 

CALL  MAOCKNRBfNOIMtZHltUXSTtGCS*!.) 

MP.XTE<KLIST»10i» 

Ifl  FORMAT  (“f- REG/ PI  GAIN  MATRIX— GCS”/) 

CALL  HATIC<GCStNRQ«NOINt3) 

RETUF.N 

C  ENO  SUBROUTINE  GCSTAR 
END 
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SUBROUTINE  SCOT 

COMHON/OE  SIGN/N  VC0M«  TSA  'IP.LFLRPI  tLFLCCT  t  LFLKF  ,LTEV  AL  .LASORT 
CONHON/FlLES/KSAVE«KOATA,KPLOTt<LZSTtKTERN 
COMMON/ZMTXl/Ntf ZM.ZHl Cl> 

CORHON/ZHTXZ/ZHZai 

COHMON/NOlMO/NNCtNPO«NPO*NNO«NOD«NMOtNHOOtNPLO«NMPNMC*NNPR 

COMHON/NOIMC/NNCtNRCtNPC 

COHHON/CHOMTX/NtfCH,NrwCN*NOOC»CMCl) 

COMMCN/LREGPI/L  XOH.LU!;M»LPHCLtLKX,L<Z 
COMMON /CPFGPI/NVRPI.RPKII 

C0HH0N/LCGT/LAll,LA13«LA21,LA23f LAl£«LAZZtLKXAll,L<XAi2«LKXA13 
COHMON/CCGT/N\/CGT,CGT(l» 

IF(NEWCM)  2^*2w,15 

15  NSIZE=  INND*2»NP0I  •(  NNC4-NPC+N0D) 

ifinsize.lf.nvcgti  go  to  Ife 

MRITE  1'’6,NSIZE 

LfiBOPTsNSIZE 

RTTUCN 

16  IF(NN3.G£,NNC)  GO  TO  17 
WRITE  1*7 

GO  TO  1» 

17  IF(NN0.GE.N00»  go  TO  19 
H5IT"  i*e 

18  LS90RTS-1 
R- TURN 

19  LAllsl 
LA13sLAll+NNO*NNC 
LA21=LA13+KND*N00 
LA25=LA21+NP0*NNC 
LA12=LA25+NP0*N00 
LA22=LA124NND*NRC 
LKXA11=LA22*NR0*NRC 
LKXAi2*LKXAll*NP0*NNC 
LKXA1T=LKXA12+NP0»NPC 

call  CGTA  (CGTILAlil  »CGT(LA13)  *CGT(Lm21)  .CGTILAZ  J)  «CGT(LA12I  t 
1  CGT(LAc2)  ,ZN1,ZH2) 

Zu  CALL  CGTKXfCGTiLAll)  •CGTfLAlT)  tCGTILAZl)  ,v,GTf  LA23)  fCCT(LAl2), 

1  CGT(LA22) •CGTfLKXAlll ,CGT(LKXA12) ,CGTfLKXAl3) ,RP1 CLKXII 
LFLCGTsI 

ine  FORMAT  I'T  insufficient  MEHOOV  /CCGT/,  need*  “tlD 

1-7  FORMAT  FEWER  DESIGN  MODEL  THAN  COMMAND  MODEL  STATES") 

I' 8  FORMAT ("FEWER  DESIGN  MODEL  THAN  DISTURBANCE  MODEL  STATES") 
RETURN 

C  END  SUBROUTINE  SCGT 
END 


SUBROUTINF  CGTA(Ail,Ai3,A21,A23«A12,A2E«ZHi«ZMZ} 
C0HNCN/KAINi/N01H,N0IH1,C0M1(1) 

comhon/files/ksave,koata,kplot,klist,kterm 

COMMON/SV ?MTX/NtfSM,SM(l) 

COHNON/NOIHi}/NNDtNRO*NPOtNND»NDr)«NMOtNMOOfNPLO»NHPNHOtNNPR 
C0MM0M/L0C0/LAPfLGP,LPHI,L9D,LEX,LPHDfL0,i.QN,L00,LC.L0y  ,LEYtLHO,LR 
COMMON/DSNHTX/NY9M, NOOV.NOEV , OMC 1) 

COHMON/NDI**C/NNC,N«?C,NPC 

COMMON/i.OCC/LPHC.LaDC»LCC,LDC 

C01H0N/CM0HTX/NVCM,NSMCM,N00CtCH{l) 

COMMON/LCNTRL/LPIll»LPI12.LPI21tLPIc2,LPHCLtLBDL 

CO**HON/CONTROL/NVCTLtCTLCll 

DIMENSION  All (II • Al3 (1 1 « A21 ( 1 1 , A23(l) . A1 2 (1 1  * A22( 1 1 « ZMl (1 1 tZM2 (1 1 

NDIMsNND 

NOIHl= NOTM+1 

CALL  TFRMTX(C'1,ZM1,NNC,NNC.2» 
call  SUBI (ZMltNNCtNOIM} 

call  FMMULfCTkCLPIlZI «CM(LCCI tNNO,NRO, NNCtZMZ) 

CALL  SCALE(ZM2tZM2,NNDtNNC»-l.> 

N3=MAX5<N0C»NNC) 

L2*1*NN0*NN0 

L7sL2*NNO*NB 

L4=L3*KND*NB 

L5sL4*NND*NND 

L6sL5*NND»NND 

NSI7E=L6*nPD« NNC-1 

ifcnsize.le.nysmi  go  to  1 

WRITE  I'ktNSIZE 

1**2  FORHATC*' INSUFFICIENT  MEMORY  /SYSMTX/,  NEEOI  ",14) 

LABORTsNSIZE 
R- TUCN 

1  CALL  AXBMXCICTLfLOIllI ,NNO,ZMl,NNC»ZH£f Ali,SM, 
i  SM(L2I fSMCL3» »SN(L4I ,SM(L5} I 

CALI  MMOL (AlltZMltNNOtNNCfNNCtZMZI 

CALL  FMMULICTLCLPIZII » ZM?,NPO. NND ,NNC, A21) 

CALL  FMMUL(CTL<LPI22) ,CMCLCC) »NPD»N=0,NNC»SMCL6) » 

CALL  FMMULCAll, CM (L30C) ,NNO, NNC  »NRC ,SM) 

CALL  FMMUL(CTi.(LPIil)  f  SH,NND,NN3,NRC, AIL) 

CALL  FMMUL(CTL(LPI21) »SM,NPO,NND,NRC. A22) 

IF(NC0C.E0.11  go  TO  2 

CALL  FMMULCCTL(LPI12I ,CM(LDC) *NNO.NRD,NRCtSM (L2I ) 

CALL  FMAnC(A12,SM(L2l tNN0,NFC*A12) 

CALL  FMMUL(CTL<LPI22I  .CM(LDC)  ♦NPD,NRQ,NRC,SMtL2n 
CALL  FMACO(A22,SM(L2l f NPD «NRC« A22) 

2  IF(NOO.EQ.?l  GO  TO  15 

CALL  MHUL(CTL(LPI11) tOM(L£X} ,NNOtNN3,NOO«ZM2l 
IFfNOEY.EG.il  GO  TO  5 

CALL  FHHULfCTLfLPIlZI .OMfLEYI ,NN0.NR0«N00«ZM1) 
call  HA0C1(NN0,N0D.ZM1,ZM2,ZM2,1.) 

5  CALL  TFRMTX<Cii(LPHDI  ,ZM1.N00,NCD«2) 

CALL  SUBKZMl.NOOfNOlM) 
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CALL  AXBMyCfCTLILPlil) «NNO« ZMl tNDDt ZH2 , Aio» SH» 
1  SNtL2l«SFIL3)tSMILUt,SH(LS) ) 

CALL  HHUL(Ai3*ZHl,NND*NbD*N00tZM2l 
CALL  MACC1(NN3«N00*ZH2,CH(L£XI tZM2«-l. ) 

CALL  »^HHUL(CTL(LPI21I  «ZM2  •NPO*NND«NDO«  A23) 

15  NOIHsNPO 

NDIM1=ND1N*1 

CALL  MA001(NP3,NNCt A21f SM(L6)tA21«l.  > 
IF<N0EY.E0.1)  GO  TO  2^* 

CALL  MMUL  CCTLCLPI22I ♦CH(LEVI »NPD,NRD,NOOf ZMl) 
CALL  MAnoi(NPO*NOO«A23»ZMl,A23»-l.) 

2.  call  MATLSTIAll,NNDtNNC,“Ali“,<LlST) 

CALL  MATLST<A21,NPO,NNC#"A21”,KLIST) 

CALL  maTLST(A12 ♦NND*NRC.“A12“.KLIST) 

CALL  MATLFT(A22  .NPQ.NRCt ••A22“,KLIST) 
IFINDO.GT.CI  GO  TO  25 
WPIT£<«LTST,l-;i) 

itl  FOPHAT(***MATRIC£S  A13  ANO  A23  ARE  ZERO”) 

RETURN 

25  CALL  MATLST(A13,NNO,NOD.**A13“.<LIST) 

CALL  MATL?T{A23,NPO,NCO,~A23“tKLlST) 

RETURN 

C  EMQ  SUBROUTINE  CGTA 
END 


SUBROUTINE  AXBMXC I A, NA , P, NB, C»X, AU, 3U,R , Zit Z2 » 

COMHON/HAINl/NDIM,NDIMi,COMl(l) 

CONMON/FlLES/KSAVE«KOATA,KPLOT,KLIST,KTtRM 

OININSICN  A(i)«B(l) ,C<1) «X(1) »AUI1) tBUCl) »R(i) yZlCl)  .ZE(1) 

DATA  “MAy  ,ITMAX/1,E-6*3/ 

CALL  TRANS1<NA,A,Z1) 

CALL  EIG£N(NA«Zl,Z2tZ2(NDIMl) «AU»1) 

CALL  TRANS1(NA,C0M1,Z1) 

CALL  £IGEN(NQ,B,72,Z2(N0IM1) »BUtl) 

CALL  EQUATEfF.  ,C«NA«NB) 

IT*'' 

1';  call  MATLACAUtRf  NA,NA,NB*Z2) 

CALL  MATl(Z2f BU«NA«NB*N0«R) 
call  SLtfSHRtZlf NA«C0Ml,N3fR«NCIH) 

CALL  MATn (RfBUtNA»N3tNBfZ2) 

CALL  MATl (AU«Z2«NA,NA,NP«R) 

IFIIT.GT," )  GO  TO  15 
CALL  EQUATEIXtRtNAfNB) 

GO  TO  3' 

15  CALL  MA001(NA,NB,X«Rf X«l.) 

CALL  ENORM(RtNA,N3«EN) 

IFCEN.LE.EMAX)  RETURN 
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ifcit.lt.itmaxi  go  to  3* 

HRlTECKLIST.l'.l)  EN 
HCITE(KT£f?rt,111>  EN 

iJl  FORMAT  (-C  SOLUTION  ERROR  FOR  'AMCGTl  AFTER  3  ITERATIONS  »  ".iPclS. 
17) 

RETURN 

3:  CALL  HATI (A*X«NA«NA .NBtZE) 

CALL  MATl (ZE.Bf NA,N3*NB«R) 

CALL  HACDKNAtNa.XtRtR**!*) 

CALL  MA001<NA,NB.R«C«R«1«) 

IT=IT+1 
GO  TO  1; 

C  END  SUBROUTINE  AXBMXC 
END 


SUBROUTINE  SL\/SHR(  A,NA,  B«NB«C«NO) 
COMMON/M4INl/NOIM«NOlFl,COMi Cl) 

COMMON /I NOU/KIN,KOUT*KOUNCH 

OX M -NS ION  ACNOtl) ,S(NC«1)*CCNC»1) «VC16) tM«*> 

L=1 

5  LMlsL-l 

OL*! 

IFCL.tO.NE)  GO  TO  8 
IRC3(L+l,L).N£,:*)  DL*2 
8  LL=LMl>OL 

If  K~'l='<-1 
OK*l 

IFCK. EO.NA)  GO  TO  12 
IF|A(K,<*1).NE,'- .)  OK  =  2 

12  KRsKMl+OR 
AKK=A(<,K) 

3LL-BCL«L ) 

IPCCL.EO.E)  GO  TO  35 
IFCDK.EQ.Z)  GO  TO  ZT 

IFCL. ^Q.l)  GO  TO  13 

CfKfL)*CCK,L)-ARX*D0T3ILMl,C(K,l) »B(1tL) ) 

13  IFCK.EQ.I)  GO  TO  18 
DO  15  I*1»KM1 

15  C(KfL)=CCK,L)-A (K,I)«00T3(L«CfI*l)«Bfl,L)) 
18  VCl)sAKK*BLL-l, 

IFCVCD.EQ.O.)  GO  TO  99 
C(KfL)«C(KtL)/V(l) 

GO  TO  9E 

2"  IFCL.EO.I)  go  to  22 
I1*K 
I2»« 
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I3»LM1 
GO  TO  2U 

IFCK. EQ.il  60  TO  1C 
11=1 

I2*KM1 

I?=L 

00  28  1=11,12 

y (It =00T3 <13,0(1,11  ,8(1,L1) 

C(K,L)=C(K,LI*A(K,II«tf(l) 

C(KK,«.)=C(K<,L)«A(KK,II*y(l) 

IFdl.EQ.KI  GO  TO  2? 

V(1I=AKK*BLL-1. 

V(2lsA (KK,K)*BLL 

V(3)=A(K,KK)*8LL 

y(4)=A  (KK,KK»*8lL-1. 

v(5»=i./<v(iJ*y  (ai-vizi’Vd)  > 

V(6l=V(5)*(C(K,L)^V(A)-V(3»*C(KK,L)) 

C(KK,LI  =  V  (5)*(V(l**C(KK,LI-V(2)*C(K,Ln 

C(K,L»=V(6J 

GO  TO  95 

IF(CK.EQ.2)  GO  TO  5? 

IF(L.£Q.11  go  TO  38 

11  =  K 

12  =  K 
I’=LM1 
GO  TO  4" 

IF(K.EO.l)  GO  TO  45 
11  =  1 
I?=KM1 
I’  =  LL 

00  4?  1=11,12 

C(K,LI=C<K,L)-A (K,I )*00T3(I3,C(I,1) ,B(i,L)) 
C(K,LL»=C  (K,LLI-A(K,I)*00T3(I3,C(I,1) ,B(1,LL> ) 
I'^dl.EC.K)  GO  TO  38 
V(l)=AKK*BLL-i, 

V(2l  =  AKK*P(L,i.L) 

V(3J=AKK*6(LL,LI 

V(.*»  =  AK'<*eCLL,LL)-l. 

tf{5)=i./(V(ll*V(4l-V(2)*V(3)) 

V(6)=y (5) *(C(K,L)»y(4l-tfC3)*C(K,LL) ) 

C(K,LLI=V  <5l*(V(l»*C(K,LL)-V(2>*C(K,Ln 
C(K,LI=V(e) 

GO  TO  95 

IFCL. EQ.II  go  TO  55 
V(l»=C0T3<LHl,C(K,ll,9fl,LI) 
V(2I=D0T3<LM1,C(KK,1),8(1,L) ) 
V(3I=00T3(LM1,C(K,1I,B(1,LL) ) 
V(«)=00T3(L^1,C(KK,1),B(1*LL>) 
C(K,L)=C(K,L)-AKK*V(1)-A(K,KK)*V(2) 

C(KK,L)=r  (KK,l.)-A(KK,K)*V(l)-A(KK,KKI*V(2) 
C(K,Ll1=C(K,LL>-AKK*V(3I-A(K,KKI  *V(4> 


C(KKtLLI«C<KK«LLI>A{KK,K)*VI3)-A(KK»KK)*V|i») 

55  IFCK.EQ.l)  GO  TO  6S 
DO  e: 

V(ll«00T3(LL«C(I«iltSfi«LM 
Vf2)s00T3  CLLtCdfl)  •B(1«LL)) 
C(K«L)«C(K,L)-A(K,I)*Vlil 
C(KK,LI«C(KK«l1  -AfKK,II«tf  id 
ClKfLLl<CIKtLL}-AIK«I)*V(2) 
bf'  CIKK,LL)«C(KKtLLI-ACKK*I)*V(2) 

65  Vll)sAKK*BLL-l. 

V(2|sA (KK,Kt«BLL 
V('*)sAKi<»6{LtLL) 

V(4)=ACKK«K)«3CLtLL) 

Vf 5t=AIKtKK}*3LL 
VC6l=A(KK,KKl •BLL-1. 

VI7)=AH(,KK»*BCLtLL) 

V(fit3AfKK,KK)«B(L«LL) 

V(9»=AKK*B(LL.L) 

V(1  ')=A(K'K,K)*B(LLtL) 

VI11I=AKK*BILL»LL)-1. 

V(12)=A(KK,<)«3CLL,LLI 
V(131  =  AI(<,KK)  •3<LL.L» 

V(l4lsA(KK,KK}*B(LL«L} 

V(15»=A|K»KK)*9ILL,LL) 

VI16»sA<KK,KKI*3(LL,LL>-1. 

H(l)sC(<*L) 

MI2)=C  (t<K»L) 

V<(3»=C(K,LLI 

W(4lsC<KK,LL» 

NdSsNDIH 

NOIM=4 

NDIMisN^IM*! 

CALL  000LlTI4fV«M,l,ISG) 

NDIMsNDS 
NDIHl=NOIM+i 
95  K=K*DK 

IFlK.LS.Nfll  GO  TO  1* 

L=L*OL 

ifil.le.nbi  go  to  5 

RZTURN 

99  HoiTEIKOUT.iri) 

R5TURN 

ICl  FOR^^AT("^•  •  •  ERROR  IN  CGT  SOLUTIONI  All->A23”» 
C  ENO  SUBROUTINE  SLVSHR 
END 
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SUBROUTINE  ENORHC A, NRf NC»ENRM) 
COHNON/KAINi/NOIH,NOIHl,COHl(i) 
DIMENSION  A(ll 

ENRHs-  , 

NE*NC*NDIM 
DO  1C  1*1,  NR 
DO  1*^  J*I,N£,NOIN 
!•»  £NRH*ENRM<fACJ)*Af  Jl 
£NRM*SQRT  (ENRM) 

RETURN 

C  END  SUBROUTINE  ENORM 
END 


SUBROUTINE  CGTKX { All, A13, A21 , A23 , Al2, A2E,RKX All ,RKX Al2 , RKXAi 5 ,RKX| 

C0MM0N/MAIN1/NDIM,NDIN1,C0M1(1I 

COMMCN/FIL£S/KSAVE,KDATA,KPLOT,<LIST,k:TER« 

COMMON/NOIMD/NNO, NR0,NP0,NM0,NDD,NMD,NWDD,N»LD,NMPNMD, NNPC 
COMMON/NDIMC/NNC,NRC,NPC 

OIMENSICN  A11C1I,A13<1I ,A21(l»,A23(l>,Ai2il),A22(i) , 

1  'fKXAlHi),RKXA12Cl>  ,RKXA13 ( 1 )  ,RKX C t » 

NOIHsNRO 

NDIM1*N0IN*1 

CALL  FHMUL<RKX,Ail,NRC,NNO,NNC,RKXAll) 

CALL  MADDl(NR0,NNC,RKXAll,A2i,RKXAli,l, ) 

CALL  MATLST»R<XA11,NRC,NNC,"KXM’*,KLIST) 

CALL  NATLST(FKXAll,NRD,NNC,“KXM*’,KTERM) 

CALL  FMMUL<RKX, A12,NRP,NN0,NRC,RKXA12) 

CALL  MA001(NRD,NRC,RKXA12,A22,RKXA12,1.) 

CALL  MATLST(RKXA12,NF0,NRC,"KXU**,KLIST) 

CALL  MATL?TCR<XA12,NF0,NRC,~KXU”,KTERM) 

IFCNOu.lt, II  RETURN 

CALL  FMNULCRKX, A13,NeO,NND,NCD,RKXAI 3) 

CALL  MAODKNRO,  NOO,  RKXA13 ,  A2 3, R< X  A1  3, 1 ,  I 
CALL  MATLST<RKXA13,Nk,0»NDD,~KXN~,KLIST) 

CALL  MATLST<R<XA13,NR0,NDD,-KXN**,KTERMI 
Re"  TURN 

C  FNO  SUBROUTINE  CGTKX 
END 
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SUBROUTINE  CEVAL 

CONNON/NA INl/NO  Z  H«  NOZ  HI •COHi f 1 ) 

COHHON/IKOU/KINfKOUT«K»UNCH 

COHMON/OE SIGN/NVC0H,TSAHP,LFLRPI.LFLCGTtLFLKF,LTEVAL.LA30RT 

C0HH0N/FILES/KSAVE,<0ATA,KPL0T,KLIST.KT£RH 

COHMON/SY  SHTX/NVSH, SM (1) 

COHMON/ZMTXl/NVZM.ZMl 111 
C0MH0N/ZMTX2/ZH2C1I 

C0HH0N/N0ZH0/NNQ«NR0»NP0tNHD»Nf}0*NH0*NMn0*NPL0»NMPNW0tNNPR 
C3HN0N/N0IHC/NNC*  KRC«  NPC 

copmon/«.p.egpi/lxom,ludw,lphcl.lxx,lkz 

COHMON/CF.EGPI/NVRPItRPKl) 

OIHENSICN  NPLOTI2),NVPLOTClf  l♦NSC6) ,LSCL(£» , ITITLE C5 ) 

DATA  NC/lHN/ 

MRITE<KLIST,llvl 

F0RMAT(////11X,5("*  "»  ♦‘•CONTROLLER  EVALUATI0N“,5  C*  •")////) 
I  POLES  1 

N\/OUT=NRO+NPO*l 
IP<LFLCGT1  17tl7,15 
W'lTE  l''-6 
READ*, lUM.VUM 
IFCIUH.LT.l)  GO  TO  Z' 

IPaUH.GT.NRC)  GO  TO  15 
NVOUTsNVOUT*NPC 
NPsNNC 
GO  TO  19 

IFIlPOLE.EQ.il  CALL  POtESCRPI (LPHCL ) .NNPR ,4 , ZMl »ZM^I 
NPs? 

CALL  VOUTIC(SH,NVFLOT,NPLOT,NVOUT,LSCL) 

IF(NVOUT.eQ.r I  GO  TO  7' 

WOITE 

REAO*f TEND 
TFITtKOI  2J.2:,25 
LVX':  =  NV0U'»’*1 
LX'isLVX  ♦NVOUT 
LX1=LX3*NPL0 

lxm:=lxi+npld 

LXNlaLXM'u  ♦NP 
NP*LXM1+NF 
00  26  IsLVXQ.NO 
S^•CI»  =  3. 

CALL  CTREEPISNCLVX'*)  .SH.SHILXll  ♦SMCLXll  ,SM(LXM.  I♦S1CLXN1)  ♦ 

1  ZNltNVOUT.TENOflUNfVUN.NST) 

HRITECKTERM,!'?!) 

REA0CKIN,102)  ITITLE 

Ms5''*NST 

00  4^  I«lt2 

NSlAlsl 

00  26  Js2t6 

NSfJI*NSC  J-1M51 

NPsNPLOTCII 


IP<NO,EQ,')  60  TO  4T 
NPPlsMP+1 
PiHINO  KPLOT 
NSVs5*I-4 

CALL  RPLOTFCZH1,NVOUT,I£RR) 

CALL  STPPLTtSM, ZMi, NS ,NVPLOT (NStf) tNO«NV0U1} 

00  15  J=1  ,M 

CALL  RPLOTFfZiifNVOUT.IFRR) 

IFCIEPR.FQ.il  60  TO 
IFf  HODIJ.NSTI.NE.C*)  go  TO  35 
DO  30  K=1,NPP1 
3C  NSIK)  =  NSHf|+l 

CALL  STRPLTCSH.ZMI.NS.NVPLOTCNSV) .NP.NVOUT) 

35  CONTINUE 

CALL  FLOTLFCSif NP.SH.LSCcCIi ,1.  .KTERM, ITITLEI 
4"  CONTINUE 

N7H=NV0UT-1 

M=N7M/5 

n:=5**< 

IFCH.EO.C 1  GO  TO  So 
DO  5F  1=1. NE, 5 
NTClIsl 
DO  Hc  Js2t6 
49  NEC  J)sNS( 

R-WINO  KPLOT 
NVS=I-1 
00  45  Jsl.5 
45  N7PL0T (J|sNVS*J 
DO  5"  J=l,131 

CALL  RPLOTFCZNt.NVOUT.IERR) 

IFC lERR.EO.l)  GO  TO  55 

CALL  STRPLTCSi,  ZN1.NS,N7PL0T,5.NV0UT» 

DO  48  Ksi.e 
48  NSCK)=NS(K}^1 
S'-  CONTINUE 

call  PLOTLPClil.S.SN.l.l.l.KLIST.ITITLE) 

55  CONTINUE 

56  N7H=NVM-N£ 

IFCNVM.LT.l)  60  TO  7' 

NPPl=N7Mtl 

N?C1)=1 
DO  57  1*2,6 

57  N5II)*NSCI-1)*1C1 
DO  58  1*1, NVM 

58  NVPLOTCI|sNE*I 
REHINO  KPLOT 
DO  65  1*1, 1^1 

CALL  RPLOTFCZMl,N¥OUT,IERR) 

IFf IPpR.EO.lI  60  TO  7C 

CALL  STRFLTCSH,ZM1,NS,NVOLOT,NVN,NVOUT) 

00  60  J*1,NPP1 
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61  NStJ»sNS(J)n 
65  CONTINUE 

CaLL  »L0TLP(1J1#NVM,SH.1,1,1*KLIST,IT1TLE) 

7P  H?ITE  ly4 

READ  ill. IANS 
IFflAKS.CQ.NOl  RETURN 
loOLEs? 

GO  TO  1’’ 

ICi  FCRHATf  ENTER  TITLE  IN  GIVEN  ^lELu  “.It.  C”-“l  .“♦"/I 

irz  FORMAT<5Al«| 

iri.  FORMAT  (“*  PORE  TIME  RESPONSE  RUNS  CV  OR  NJ  >**l 
126  format C“f ENTER  MODEL  INPUT  AND  STEP  VALUE  I  1  >“) 

1*8  FORMAT C“  ENTER  TIME  DURATION  FOR  RESPONSE.  IN  SECONDS  >“» 

111  FORMAT (A?l 
C  END  SUBROUTINE  CEVAL 
END 


SUBROUTINE  VOUTIC  < ViC .NVPLOT , NPLOT. NVOUT.LSCL  » 

COMMON/OE SI GN/NVC0M,TSAMP,LFLRPI.LFLC6T.LFL<F,LTiVAL.L ABORT 

common/files/ksave.kdata.kplot.klist.kterm 

COMMON/NCIPO/NND.NFO.NPO.NMO.NDO.NKD.NWOD.NPLO.NWPNMD.NNPR 

COMMON/NOIMC/NNC.NRC.NPC 

CCMMCN/NDIPT/NNT.Ne'T.NMT.NHT 

DIMENSION  NPLOr (ll.NVPLOTtl) .VICfl) .lOUT(E) .LSCL(£) 

DATA  lOUT/lHX.lHY.lHU.lHM.lHD/ 

IFILTEVAL)  2.2.5 

NVS=NND 

NVsNFlD 

GO  TO  8 

NV=NNT 

NVSsNV 

NVOUT=NVOUT*NV 
DO  9  I=l,NVOUT 
VI0<I)  ="•• 

NVU=NV*NPD 
NVMsNVU*NFD 
WRITE  iri.NVS 

FORMAT  CT  ENTER  STATE  AND  IC  VALUE  C  /  TERMINATESM  “.12.“  >“) 
READ*. IV. V 
IF(IV.LT.I)  GO  TO  15 
IFCIV.GT.NVSI  GO  TO  1? 

VTC(IVI»V 
GO  TO  12 

I^f fLFLCGT.LT.l).OR.(LTEVAL.EC.l).OR.fNOO.LT.i)l  GO  TO  25 
LDsl 

WRITE  1<‘2.N0D 

I^^ORMATC“  ENTER  DISTURBANCE  IC  VALUE  {<  /  TERMINATESM  “.12.“  >“» 
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2C  R‘fftO**lV,V 

GO  TO  26 

Il^flV.GT.NOD)  GO  TO  19 

VICCNND+IVI*V 

GO  TO  20 

25  LO*** 

26  HPITE  1-3 

ICS  FORMAT C“  2  PLOTS  OF  5  VARIABLES  MAY  BE  PRINTED  AT  THE  TERMINAL  — 
ISPECIFY  NUMBER  FOR  EACH  INi,N2)  >**l 
READ*, NPL OTCll*  NPL0Tf2l 
IFCNClOTCII.GT.BI  NPLCTC1I*5 
IF|NeLCT(2).GT.5l  NPL0TC2)«5 

IFf  (NPLOTfll.GT.'^I.OR.fNPLOTIEI.GT.  M  GOTO  27 
NVOUTs^ 

RETURN 

2T  MPITE  1(4 

i'’4  FORMAT!-  ENTER  OUTPUTS  BY  TYPE  AND  INDEX  IN  2  ENTRIES--TYPES  ARE-/ 
1  -  STATE  1  'X*-/-  OUTPUT  t  ‘Y*-/-  INPUT  I  'U*-) 

IFfLFLCGT)  3Ct33,28 
2S  WPITE  i:5 
115  FORMAT  I"  MODEL  I  'M*-! 

IF(LD.£0.1I  WRITE  l^S 
ire  FORMAT!-  DISTURBANCE  I  'a*-) 

13  00  4  1=1 1 2 

NCsN^LOT!!) 

IF!NC.LT.1I  GO  TO  4*! 

LSCL!I»sl 
NFs5*!I-ll 
WRITE  l'.7,I 

If?  FORMAT  !-o  PLOT  12) 

DO  39  JslfNC 
NSP=NS+J 

31  WPITE  r8,J 

I**  6  FORMAT!-  OUTPUT  -fI2t- 
R-AO  llltIV 
W^ITE  113 

113  FORMAT !llX,->”) 

R-AO*, 10 

IP!IV.NE. lOUTIl) I  GO  TO  32 
IFflO.GT.NVS)  GO  TO  38 
NVPLOT!NSP)*IO 
GO  TO  39 

32  lFfIV«Nc.I0UTf2l)  GO  TO  321 
IF!IO.  GT.NPO)  GO  TO  38 
NVPLOT!NSP)*NV»IO 

GO  TO  39 

321  lPfIV.NE«I0UT!3n  GO  TO  33 
IFIIO.GT.NRD)  GO  TO  38 
NYPLOT!NSP)>NVU^IO 
GO  TO  39 

33  IFILFLCGT.LT.II  GO  TO  31 
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IFfIV.Nt.I0UT(4n  GO  TO  34 
I^dO.GT.KPC)  60  70  36 
NVPLOT(NSPI«NVH«IO 
LSCLfI)«-l 
GO  TO  39 

34  IFfLO.NE.l)  60  TO  31 

I^(1V.NE.I0UT(9) I  GO  TO  31 
IFf lO.GT.NOOl  GO  TO  36 
NVPLCTtNSP}«NVS«IO 
GO  TO  39 

38  M51T£  rq 

irS  FORMAT  C“  INDEX  TOO  LARGE**! 

GO  TO  31 

39  CONTINUE 
4*^  CONTINUE 

Ni/Ml=NtfOUT-l 

N»=^ 

DO  Sr  I=1,NVM1 
M=*100(  *I-1I,5»  +  1 
IFIH.GT.l)  60  TO  41 
NO=NP*l 

W-IT£<KLIST,11M  no 
lie  FORMAT  plot  **♦12) 

41  IFd.GT.NVSI  GO  TO  42 
I\/aIOUT(l ) 

10*1 

GO  TO  45 

42  IFd.GT.NV)  GO  TO  43 
IV=I0UT(5) 
lOal-NVS 

GO  TO  45 

47  IFd.GT.NVU)  GO  TO  441 
IVsIOUT(?) 

I0=I-NV 
GO  TO  45 

441  IF(I.GT.NVM)  GO  TO  44 
IV=I0UT(3) 

IO=I-NVU 
GO  TO  45 

44  IV=I0UT(4) 

IO=I-NVM 

45  MhIT£(KLIET,ll2)  M,IV,IO 
5?  CONTINUE 

RETURN 

111  FORMATCAll 

112  FORMAT{**  OUTPUT  **,I2,**I  **,A1,I2) 
C  END  SUBROUTINE  VOUTIC 

END 
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SUBROUTINE  CTRESPI\rXil«VXl,X^«Xl«XH:«XN^«ZNltNVOUT«TcNOtIUH,VUM« 

1  NST» 

COHHON/Dc SlGN/NVCOMfTSAHPtLPLRPItLFLCGTtLFLKFfLTEVALfLABORT 
COHNON/FILES/KSAV*,KOATA,KPLOT,KL1ST,KTERN 

COHMON/N01HO/NNO«NROtNFC»NHO*NDO«NWD»NMOOfNPLOtNWPNWO*NNPR 
COHMON/LOrO/LAP,LGP.LPHl»L90«LEXtLPHDtLO*i.ONtLQDtLCtLOYtL£Y«LHP,LR 
COHMON/OSNHTX/NVON. NOOV ,NOEY , CHI 1 ) 

COHHON/NOlHC/NNC,NRCtNPC 

C0MH0N/i.0CC/LPHCti.30CtLCC.L0C 

c?hhon/cmohtxxnvcm»nfwcm,nodc»cmii> 

C0HH0N/L0CT/L»HT,LB0T*LQ0T*LHT,LPT.LTDT.LTNT 

OOHHON/TPUMTY/NVTM.TMIll 

cohhon/lpegpi/lxow,luom*lphcl»lkx,lkz 

COMMON /GPfGPI/NXRPI ^RPI 111 

OIMENSION  tfX3 (11 tVXllil ,XCfll ,Xllll ,XHt 1 1) , XHl ( Xl , ZMl I i ) 

N'?TP0=.-11*TEN0/TSAMP*.5 

NSTs2 

IFINETPO.GE.I)  GO  TO  1 

NSTPO=l 

NSTal 

1  NST£PS*H  .  ♦NSTPO 
IFCLFLCGT.tQ. J)  GO  TO  2 
L*<OaNYOUT-NPC 
IFINOC.EO.^I  60  TO  4 
LOCGTsl 

60  TC  5 

2  LHOsNVOUT 

4  L0C6T=1 

5  LU*4M0-NPD 
LSOsLU-NFD 
NVX»LS0-1 
IF(lTEWAL)6,6,1' 

6  on  7  I*1»K'VX 

7  XlCIlsVXKII 
GO  TO  12 

I!  CALL  XFDT(VX1,X1,LDCGTI 
J2  NNOFlsNND*! 

RZWIN?  KPLOT 

CALL  YDSN(X1,VX1ILU1,0M(LCI ♦OMCLOY) ,LDCGT,YX1 (LSOll 
IFIlFLCGT.EQ.iI  call  VCHD(XM1,IUM,VUM,CM(LCCI tCMILDC). 

1  VXKLHOl) 

CALL  HPL0TFCVX1»NY0UTI 
00  l-‘.  1T=1,NSTEPS 

CALL  URFI  (RPI  (LKX)  tRPKLKZ)  tOMILCl  tON(LOY)  tXC  •XltVX  j  (LU)  *  VXl  (LU)  ) 
IFILFLCGTI  2i ,2«,15 

15  CALL  UCGT  (YXLCLUl ♦ VXl ILUl t XMT , XMl , X . f NNDP-l  t ZMl ,IUM, VUM, I T1 
CALL  CUPrATIXHJ ,XH1,IUM,VUM) 

Zr  CALL  FTH7X(VXllLU)tVX’!(LU),NR0.1l 
call  FTMTXIXl.XO.NBLOfll 
IFCtTEVAL)  25,25t3l 

25  CALL  DUPDATIOilLPHl) ,DMCLBOl .DMILPHOI ,DK(LEX) .XwtXl, 
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1  VXl«VX'^(LU)«L0C6T,NHCPi) 

GO  TO  35 

3n  CALL  TUPDAT(TH(LPHT},TH(LBOn«VXC,VXl,VX.(LUIl 
CALL  XFOT(VXl,Xl,LrCGT) 

35  IFfnoadTtNSTPOl  .Nc.C  )  GO  TO  10' 
VXHNV0UTI«TSAMP*FL0AT(IT» 

CALL  YOSN  (Xi.tfXlCLUl  •ONCi.C)  t  OM(LOY)  •LDCGT  * VXl  (LSOI  ) 
ZF(LFLCGT.EQ.1}  call  YCHO(XHl,IUH»VUM,CHfi.CC)  •CH(LOC)f 
1  VXICLHO)  ) 

CALL  WPL0TFCVX1,NV0UT» 
int:  CONTINUE 

ENDFIlE  KFLOT 
RETURN 

C  'NO  SUBRPdTINF  CTRESP 
ENO 


SUBROUTINE  OUPOAT (PHI ,90,PHI C tEX t X J , XI ♦ VXi.Ur  *LOCGT, NNOPl ) 
C0rtM0N/MAlNl/N9IM,N0IMl,C0Ml Cl) 

COMMON/NniNO/NND,NRO*NPO,NMD,NOO»NWO,NWOQ.NPLD«NKPNV(0,NNPS 
OIM'NSION  PHl(i) ,BC(1) fPHIO(l) «£X(1) «X» (1),X1(1) tVXl(l) ,U^(1) 
NOIM*NN9 
NOIMlsNOIH*! 

CALL  FMWUL(BO»U‘ ,NND,NRr),l,Xl) 

CALL  HMULS{PHI,X",NN0,NN0,1,X1» 

IF(Lr'CGT.EO.»‘ I  GO  TO  11 

CALL  FFKUL(PHlOtX^(NNOPl) ,NDO tNDO ,1 , XI ( NNDPl ) ) 

CALL  HNULS<£X,XlfNN3Pi) ♦NNO» ND0» 1»X1) 

!;•  call  PTNTX(Xl»VXi,NPLD.ll 
RETUPN 

C  ENO  SUBROUTINE  OUPDAT 
ENO 


SUeROUTINt  CUPOAT(XH;;«XMl»IUHtVUH) 

CONHON/MAlNl/NOIH,NOINi,COMl(l) 

CONHON/NDIKC/NNCtNRC«NPC 

COHMON/LOCC/L«»HC«LBOCtLCC.LDC 

COMMON /C  H  OHT  X /N  VCN, NE  WCM, NOOC  t  CH ( II 

OINENSION  XHL(l),XHl(il 

NDlMsNNP 

NDIMl=NDTH+l 

CALL  FT*1TX<XM1,XH..,NNC.1I 
Ll*LAOOe;<NNCtl.IU*«l*LBDC-l 
CALL  tfSCALE(XHl,CH(Ll)*NNC.tfUM) 

call  hmulsichilphci •xh: •NNC«NNC«1»XM1) 
RETURN 

C  "NC  SUBROUTINE  CUPQAT 

HMfJ 


SUBROUTINE  TUP3 AT  CPHI  ,  BO,  VXC  ,VXl,Ui  ) 

COMMON/MAlNl/NOIM,NDIXi,COMl (1) 

COMMON/NOINT/NNT,NRT,NMT,NWT 

DI •PENSION  PHKII  ,9DC1)*VX^(1I,VXHL),U.  (1) 

N0IM=NNT 

NUlMisNDlMH 

CALL  FTMTXttfXi, VXw,NNT,l» 

CALL  FKMULC90,U: ,NNT,NRT,1,VX1) 

CALL  MMULS(PHI,  VXv,NNT,NNT,l,  VXD 

R- TURN 

C  END  SUBROUTINt  TUPDAT 
END 


4  pt 


SUBKOUTlNt  XFDTCV,X,LOCGT» 

CONHON/NOIHO/MNO«NF.O,Nl>D»NHO*N03«NHD*NHOg«NPLOfNMPNWO«NNPR 

COMMON/NOIMT/NNT*NRT,NHT,NMT 

COMHON/LOCT/L»HT.LBOT,LODT,LHT,LRT,LTOT.LTNT 

COMMON/TRUMTX/NVTM,TM(l> 

OIHENSION 

CALL  FMHULaMfLTOT)  *V»NNO»NNT»l»X) 

IFILDCGT. EQ.f >  RETURN 

CALL  FH^ULITMILINTI .VtNOD,NNT,l, XCNND*1I ) 

R-TURN 

C  END  SUBROUTINE  XF3T 
END 


SUBROUTINE  URPI (RKX.RKZ.C* DY , Xi ♦ XI, U  » Ui) 

COMMCN/VA INl/NOlM,NOIMl,COMi(l) 

C3HH0N/N01H0/NN0,NR0,NP0,NHD,NU0,NW3,NW00,NPLD,NMPNWD,NNPR 
DIMENSION  RKXdl  ,RKZfl)  ,Cti)  ,  DY  ( 1 )  ,  Xc  ( 1  >  ,  XI (X)  ,  Uj  ( , U1  ( 1 1 
CALL  YDSN<Xv,U1 ,CtOY,C ,U1I 
i*-  call  VSCALE<Ui,Ui,NRO,-l.l 

CALL  MMULS<Rl<Z,Ul,NRO,MRC,l,U.  ► 

DO  IZ  Isl,NPLO 
12  Xi <IlaX* (II-X1(II 

CALL  EH'1UL(RKX,Xw  ,NRDtNND,l,Ul) 
call  VAOD(NRO,l, ,U1,UE) 

R"TU'’N 

C  END  SUBROUTINE  URPI 
END 


subroutine  UCGTCU-,Ul,X*1'  ,XM1,0DIF,ZH1  tlUMfYU**,!!) 
C0MM0N/MAIN1/N0IM,NDIM1,C0M1(1) 

C0MM0N/NDI«D/NN0,NR0,NPD,NM0,ND0,NHD,NWCD,NPLD, NWPNW0,NNPR 

common/ndimc/nnc,nrc,npc 

C0MH0N/L0CC/LoHC,LB3C,LCC,L0C 
C0MM0N/CM0MTX/NYCH,NEHCM,N0DC,CM(1) 
cohmon/lregpi/l  XOW,LUD«,lPHCL,LKX,LKZ 
C0MM0N/CF£GPI/NVRPI,RPIC1I 

C0NN0N/LCGT/LAll,LA13,LA2jL,LA23,LA12,LA22,LKXAll,LKXAl2,L<XAl 
COMMON /CCGT/NYCGT,C  GT  ID 

dimension  Ujll)  fUxIll  ,XHJI1)  tXMlfl)  ,gCIFdl  tZMlID 
CALL  YCMDIXM',IUM,VUM,CM|LCCI,CM(lOC»,U  » 

IFIIT.GT.I)  GO  TO  1? 

IaL<XA12+LAODR<NPa,l,TUMI-l 
CALL  MAODl(NPD,X,Ui,CGTII) ,U1,VUM) 
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i)  CALL  HHUL$(RPX(LKZ) «U9tN0IHtN0lH«l>Uil 
09  12  IsitNNC 
12  XM3<II«XHllll-XHf)  (Zl 

CALL  Ft!KULCCGTfLKXAil)  tXH^.NFO.NNCdtU'; ) 
CALL  VA0D(N9I*1tl«  fUltU.}) 

IFINOD.EO.ri  RETURN 
DO  14  IsltNOD 
14  D^Ifllla-DDIFdl 

CALL  HMULF(CGT(LKXAi3) tCOIF»NPO«NDD«ltUi) 
R‘^TU®N 

C  FNO  SUBROUTINE  UCGT 
EN9 


SUBFOUTINL  YCSN (X,U,C,D,LDCGT,Y| 

CCHMnN/t*AINl/N0IM,N3IMi,C0Ml  ID 

CONMON/NOIHO/NN9«NRO,NPC«NMOtNOOtNH3,NWCD,NPLOtNMPNMOtNNPR 
C0HH0N/L0C0/LAP«LGP,LPHl,LBD«LeX,LPH0*LQ»i.QN*LQ9fLCtL0Y«LEY»LHP,LR 
COPHON/DSNMTX/NVOM, NODY,NOEY, DM ( D 
DIMENSION  XllttUlll  «C(D  .DID  tYll) 

NDIH=NO0 
N0IM1  =  NDIM+1 

CALL  FMNUL(C»X,NPO,NNOtl»Y) 

1F(N0SY*E0.1»  GO  TO  1? 

CALL  MM'  SCO,U,NPD,NPDtl.Y) 
ir  IFICLDC&f.EQ.II  .OR*  CNOEY.EQ.D)  RETURN 

CALL  MMULS(DM(LEY)«X(NND*D  «NP0«N00tltY) 

RETURN 

C  END  SUBROUTINE  YOSN 
END 
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SU9R0UTINP  YCH0(X,IU«VU«C»0«V) 

COHMON/MAlNl/NOINtNOIHl.COHKlI 

COMMON /NDINC/NNC«NRC«NPC 

COMHON/CMOMTX/NVCM,NEttCH,NOOCtCi(l) 

OIHcNSION  X(1),C(1I«0(1}»Y(1) 

NDIM*NPC 

NDIM1=N0IM*1 

CALL  FMMULCC.X,NPC*NNC,1,Y) 

IP(NOOC,E0.1l  RETURN 

Ll*LAOOP.(NPC,l,IUI 

CALL  MAC01(NPC«1«Y,0(L1)«Y,VU) 

RETURN 

C  END  SU3ROUTINr  YCMO 
END 
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SUBROUTINE  FLTRKIIFLTP) 

C0HM0N/MAIN1/N3IM,N0IH1,C0H1(1) 

C0NH0N/MAIN2/C0H<:(H 

COMMON/DE SIGN/NVCOM,TSAHP,LFLR®I,LFLCGT,LfLKF,LTEVAL,L ABORT 
COMMON/FILES/KSAVEf <0ATA,KPL0T,<LIST.KTERH 
C0MM0N/SYSNTX/NVSM,SM|1) 

COMMON/ZNTXl/NWZMtZHKlI 

CONMON/ZMTX2/2H2(l) 

COMMON/NCIIMO/NNQ,NRD,NPO,NMO*NDO,NWO,NM3a,NPLD,  NWPNHDt  NNP«? 

C3HMON/LOCD/LAP,LG»fLPHl*L3C,LEX,LPHO,i.O,LQN»LQD.LC»LOY,L'V,LHP,L 

C0MM0N/DSNMTX/NV0M,NPPY,N0£Y»D»'(1) 

COHMON/LKF/lEADSN.LFLTRK.LFCOV 

C0HH0N/CKF/NVFLT»FLTI1» 

IFCNMPNWC.GT. GO  TO  1 
HRITE(KT£FH,i i8» 

ire  FCRNfiTC". MO  DRIVING  NOISES  -  -  FILTER  DESIGN  ABORT") 

RETURN 

1  I^  (N‘<D.GT.*)  GO  TO  2 
W^ITECKTErH^ng) 

FORNATflNQ  MEASUREMENTS  -  -  FILTER  DESIGN  ABORT") 

RETURN 

2  MRIT£(KLIST,11" ) 

11'  FnRMAT|////llx,5 ("♦  “),"FILT£F  DESIGN"»5<“  •")////) 
NSIZ£sNPLD*U«-NPLO*NMC) 

I*' (N'JIZE.LE.NVFLT)  GO  TO  3 
N=  ITE  1*  1,NSIZE 

1*1  format ("INSUFFICIENT  MEMORY  /CKF/,  NEED)  "tl^) 

LABOFTsNSIZE 

RETU'^N 

?.  NDIMsNPLC 

N0IMI  =  N0IM*1 

5  I^tNHO.EO.ri  GO  TO  12 
IFdFLTR.Lc.:  )  GO  TO  6 
M=>ITE  1*5, NHC 

1' E  FORMAT("  ENTER  STATE  NOISE  STRENGTHS!  ",Ic) 

CALL  RQWGTS(OM(LQ),NWn,r ) 

6  call  OVCTOP(NMD,OM(LQ) ,ZM1) 

CALL  MATlSTCZM1,NMD,1,"Q",KTERM) 

ir  CALL  MATLST(DM(LQ),NWD,NMD,"Q",KLIST) 

12  IF(NM00.E0,3)  go  to  18 
I'^CIFLTR.LF.C  )  GO  TO  13 
WRITE  n6,NWDD 

ire  FORMAT ("  ENTER  DISTURBANCE  NOISE  STRENGTHS!  ",I2) 

CALL  ROWGTS(OM(LON) ,NWOD,L) 

13  CALL  OVCTOR(NHOO,DM(LQN),ZMl) 

CALL  MATLST(2Ml,NHOD,l,"QN",KTERM) 

15  CAlL  MATLST(0M(LQN)  ,NhOO,NWDO,"ON",t<LIST) 

18  CALL  DOSCP.TIOM(LQ),OM<LQN)  ,ZM1,ZM2) 

IF(IFLTR.LE.C)  go  to  19 
WRITE  l'’7,NMD 

1-7  FORMATC*  ENTER  MEASURRHENT  NCISE  STRENGTHS!  ",I2) 
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CALL  RQMGTSfOKLRI  .MHO.r  » 

19  CALL  DVCTORCNMOtOKtLRItZHl) 

CALL  MATLST(ZMl,NMO,l,“i<",KTERH) 

2»3  CALL  MATLST<O‘i(LRItM*'0*NMO.“R”,KLIST» 

25  CALL  IFP.HTXCDiCLHRI  ♦SM,NMO*NDIM,2» 

CALL  TRANF2(N'i0,N0IM,SM,ZMl) 

LFCO\/=LFLTRK+NOIM*NHD 

CALL  OVCTOR(NiD*OMtLR) trLTILFCOV) ) 

CALL  KFLTRINCIi.NMO»FLT»ZMl,DMCLOD) ,FLTfLFCOV» ♦ZMZ, 
1  FLT(LFLTFK|,SMI 
CALL  TFRHTX{SH,C0M2,N0IM,NDIM,2» 
rA=i 

DO  3  Isi.NPLO 

FLT(LFC0V-1+I»*SQRTCZH2CIAI ) 

3"  IA=IA*NDTM1 

CALL  MATLSKFLTILFLTRKI  ♦NOIH,NMDt-KF~»KLlST» 

CALL  HATlSTCFLT (LFLTRKI ,N3IM« NMD ,~kF-,KT£kH) 

IFLTR=1 

LFLKPsI 

111  F-^RMATtA?) 

R'TUON 

C  £KO  SUgROUTINt  FLTRK 
EMO 
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SUBROUTINE  FEVAL 
COHHON/MAINi/NOIM,N3IMl,COHl (1) 

C0MH0N/MAIN2/C0H2<1I 

COHHON/INOU/KlN,KOUT,KPUNCH 

COMMON/Or:SI6N/NVCOH,TSAMP,LFLRPI.LFLCGT,LFLKFfLTEWALfLABORT 

comhon/files/ksave»kdata,kplot#klist.kterh 

COHHON/SVSMTX/NVSM,SH(l» 

COHMCN/ZMTXl/NWZH.ZHltll 

C0MM0N/ZMTX2/ZM2(1» 

COHHON/NDIMO/NNCtNRDtNPCtNMO.NDD.NHCtNWrOtNPLOtNHPNHCtNNPR 

CO*«MON/LOCO/LAP,L6P,LPHl«LBD*L£X,LPH3,LQttQN,LQ3«LC«t.OY,LEY,LHP,L' 

CCiMCN/DSNMTX/MVOH,NOOY,NO£Y*DMCl) 

C3*1HCN/NDIMT/NNT»NRT,NNT.NW7 

COiMON/LOCT/LPHT«L80TtLQOT.LHT,LRT,LTDT,LTNT 

C0HM3N/T«?UMTX/NVTM,TH<1» 

common/lkf/lfaosn,lpltrk,lfcov 

C0HM0N/CKF/NVFL7,FLT (1) 

OIN£NSION  ITITLH(5»  ,NSI 3) .NVPLOT C 2) 

IF(NWT,GT,i;l  GO  TO  1 
M=ITE(KTEPM,1''8) 

l**e  FORMATC’^NO  TRUTH  MODEL  DRIVING  NOISE  -  -  FILTER  EVALUATION  A90RTE 
1D"> 

RETURN 

1  HRITE(KLIST,lx: » 

11*  F0RHfi’(////llX,5C-»  ’"),~FILTER  E  VALUATI  ON*N  5  ("  ♦*•)////) 

CALL  FMMUL<C0M2,FLT<LEADSN),NPL0,NPL0,NPLJtSM) 
call  P0LES<SM,NPL0,5«ZM1.ZM2» 

NAsNNT+NPLD 

NSIZEsNA*NA 

IFCNSIZE.LE.NVSHI  GO  TO  8 
WRITE  1'1,NSIZE 

in  FORMAT  ("r  INSUFFICIENT  MEMORY  /SYSMTX/,  NEEDI  "tl**) 

GO  TO  9 

8  IF(NSIZ£.LF,NyZM)  GO  TO  IJ 
W=ITF  mfNSIZE 

I'lZ  FORMAT  (-nNSUFFICIENT  MEMORY  /ZMTX1/,/ZMTX2/,  NEECI  -,I4) 

9  LA30RT=NSiZ£ 

RETURN 

I**  CALL  ZPAFT(SM,1,NSIZ£,1) 

NClM=NPLr' 

NnIMl=NOlM*l 

CALL  TFRMTXCTMCLRTI ,ZMl*NMOf NMD, 2> 

CALL  MAT3<NPLD,NM0,FLTILFLTRK) ,ZMi,COMll 

NVOUT=2*NPLO*l 

REMIND  KPLOT 

CALL  OACOV(SM,FlT(LFCOV)«ZM1,ZM?,NA,NVOUT,!  •) 

DO  2w  IT:  1,51- 
TTMEsTSAMF^FLOATdTI 

CALL  ACOVUDISM,TM«LQOTI ,COMl ,TM(LPHT) ,FLTtLEAOSN) , 

I  COM2,ZMl,ZM2) 

CALL  OACOV(SM,FlTCLFCCV) ,ZM1,ZM2 ,NA ,NVOUT,TIME) 
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2"  CONTINUE 

cNOFILE  KPLOT 
H«?ITECKTEPM,114) 

REA0fKIN,l?2>  ITITLE 

00  5u  Isl.NPLO 

REMIND  KPLOT 

NS(l)sl 

NEC2)s52 

N'JCDlslTZ 

N\/PLOT  (1>*I+1-1 

NtfPL0T<2l*I*I 

DP  4’]  J=l,5i 

call  «<PLOTF(ZM1»NVOUT,IERR> 

IPdERS.EO.ll  GO  TO  S: 

CALL  STRPLTISN,ZM1.NS,NVPL0T.2,NV0UT) 

OP  35  K=l,3 
35  NSIKIsNSIKI^l 
4’  CONTINUE 

WRITE  137,ZMIINVPL0T<1I» ♦I,ZM1(NVPL0T<2> » 

1' 7  FORMAT  CT  FINAL  RMS  ERRORS  I  TRUE  =  “t  IPtlS..  7/**  (STATt“tI3, 

1  ••|**,4X,**C0HPUTE0  =  “,IP£15.7> 
call  PLOTLP(51t2,SM,-l,l,13,KLIST,ITITLE) 

W->ITE<KLlST,la6)  I 

!«■  F  FORMAT  STATE  I  ••,I2/74X*"SYM30L  1  I  TRUE  ERROR”/ 

1  LX,"SyMPOL  2  I  COMPUTED  ERROR  ”/) 

5?  CONTINUE 
RETURN 

i'L  FORMATi”  ♦‘Mj  ENTER  TITLE  IN  GH/iw  FIELD  ”*X'  I”-”  >  »"♦”/» 

ir.Z  format  (SAl*! 

C  ENO  SUBROUTINE  FEVAL 
END 


SURROUTINF  OACOV <ocA, PC, ZMl , ZM2 , NA, NVOUT, TIME) 

CPMNON/MATNi/NOIM,NOlMl,COMlCl) 

C0MMCN/F1LFS/KSAVE,KDATA,KPL0T,KLIST,KTERM 

COMMON /NO  IMO/NNO,NRO,N*»C,  NMD,  NDO.NHOiN  WOO,  NPLO,NMPNWO,NNPR 
CONMON/NDIMT/NNT,NRT,NMT,NHT 
COMMON/LOCT/LPHT,LBOT,LQOT,LHT,LRT,LTOT,LTNT 
C0MM0N/TP,UMTX/NVTM,TMI1) 

DIMENSION  PCACll  ,«»C  Cl )  ,ZM1  II  >  ,ZM2  II ) 

NDIMsNA 

NDlMl=NDIM^i 

call  TFRMTXITMILTOTI ,ZM1,NND,NNT,2I 
IFINOO.LT.l)  GO  TO  5 
IAslADDA’I  NA,NNO 4-1,1) 

CALL  TFPmTXITMILTNTI ,ZM1|IA) ,N0D,NNT,2) 

5  CALL  SCALEIZMl,ZMi,  NPLOtNNT,-!.) 
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lAsLAOORINAtl.NNTm 
CALL  IONTtNPLO»ZHl(lA),l.) 

CALL  HAT3(NPL0«NA,Zm,PCA,ZM2) 

MRITECKLIST.IJII  TIME 

IDl  FORMAT  f!  'TRUE*  OESZGh  ERROR  CO^TARIANCE  AT  TIME  * 
CALL  HATIO(ZM2« NPL0tNPL0«3) 

IA«1 

30  1<  Isl,NPLO 

ZMl(NS-l»sSQRTIZM2(IA»» 

ZMlfNSlsPCd) 

I**  IA*IA  +  N0IM1 

ZMHNWOUT)=TIM£ 

CALL  HPLOTr(ZMl,NVOUTl 
RETURN 

C  END  SUBROUTINE  OACOV 
ENO 


SUBROUTINE  ACOVUOfPC*  QO,Rt<RKT,PHIT»  “HI ,  RlMKH  , ZMl,  ZM? ) 
COMMON/ ^AIN1/N0IM»N0IM1,C0M1(1» 

COMMON/NOIMO/NND»NRDtNPC»NMD»NDO*NW3,NWCD»NPLDtNWPNHD»NNPR 

COHMr'N/NPIKT/NNT,NPT*NMT,NWT 

common/loct/lpht,lbot,lqot,lht,lrt,ltdt,ltnt 

C0MMCN/TPUMTX/NVTM»TMC1) 

COMMON/LKF/LEAOSN»LFLTRK,LFCCV 

C0MM0N/CKF/NVFLT,ELT<1> 

DIMENSION  PC(l)  fQOCl) ,RKRKTf 1) ,phIT Cl ) , PHi (1 » , RIMKH 1 1» , 

1  ZMl(ll,ZM2Cl) 

LI=LADDRCN0IM,1,NNT*1> 

CALL  ZPARTCZMZCLII ,NNT,NPL0,N0IM) 

CALL  TiFFMTXCPHIT,ZM2,NNT,NNT,2) 

Ll=LAODP,  C  NDIM,  NNT+1 «  NNT+ll 

CALL  TFFmtX(PHI,ZM2(L1> ,NPLD,NPLD,t ) 

L2  =  LA00RC  NOIM,NNT^i.,l> 

call  ZPARTCZM2(L2J ♦ KPLDfNNTf NDIM» 

CALL  MAT3 CN0IM,NDIM,ZM2,PC»ZM1) 

CALL  FPACOCZMi«NOIM«QC«NNT«NNT*l«PC) 

CALL  I0NT<NNT,ZM2,1,> 

CALL  FHMULCFLTCLFLTRKI ,TM (LHT) , NPLC »NM3 , NNT , ZMl) 
call  TFRM!TXC7H,ZM2CL2I,NPLD,NNT,2) 

CALL  TF*»MTX(RIMKH,7M2  fLl>  »NPLO,  NPLD,2) 

CALL  MAT3<N0IM,N0IM,ZH2,PC,ZM1) 

CALL  FPADDCZMl,NDIM,RKRKTtNPLO»NPLD,Ll,PC» 

RETURN 

C  “NO  SUBROUTINE  ACOVUD 
END 
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SU9^0UTINE  FPA30  (  XtMX  ♦N.^V,  NCY.L  A0D9  » 
OIHiNSlON  X(1),Z(1I,YCNPY*NCY} 

CALL  FTMTX(X»Z»NX,NX» 

LAHIsLAODR-1 
DO  t'  IsltNCY 
LA1sLAM1»nx*(I-H 
DO  1C  Jsl,NRY 
LAlsLAl+1 

11  ZtLAl)sZ(LAll»Y(J,I| 

R"TURM 

C  END  subroutine;  PPAOO 
END 


SUBROUTINT  RSVS (A«L»NO,ITVP£,IMRT) 

COMHON/OE SIGN/NVCOM,TSAMP,LFLRPI,LFLCGT,LFLKF,LTcVALtL ABORT 

C0HH0N/F1LES/KSAW£.K0ATA.KPL0T,KHST,KTERH 

COMHON/STSHTX/NVS^tSHfl) 

OIH£NSICN  All), Lilt  tNOIll •NA0C14«£) ,INO (7t3t , NTVPf 2* 3t «NTXTLC (31  « 
1  NUATCIA,?! 

OATA  NTTP/7,14,3,4.4t8/ 

DATA  NO/IHN/ 

OATA  IN0/lHNfiHF,lHP,iHM,lHD,lHW,2Hl«ID»2HNf1,2HRM,2hP'1,4{lH  I, 

1  2HNT,2HRT,2HMT,2HMT,1H  ,1H  ,1H  / 

OATA  NTI7L£/feHDESlGN,7HC0MMAN0»5HTRUTH/ 

OATA  NMAT/iHA,lHa.2MEK,lHGtlHQ.lHC,2H0T*2HEY,lHH,2HHNtlHR,2HAN, 

1  2HGN,?HQN,2HAH,2HBH,2HCH,2H0M,1&  tlH  I , cHAT , 2HBTt cHGTt 2HQT, LHHT, 

2  2HRT,irtTPT,3HTNT,6 (IH  )/ 

NOMsNTYO(l,ITYPEl 

NAP  =  NTY«*(2,ITYP£) 

NTsnTITLL  (ITY0£» 

WRITi(KLIST,li:’l  NT 

F0R1AT(////11X,5{"*  "I♦A7,“  MOOEL’SSC*  ••*1////) 

I'l.NT 

format (-:  READ  “tA?,"  MODEL  FROM  'DATA*  FILE  (Y  OR  N)  >"» 

R*AD  111, IANS 

ifcicks.eo.noi  go  to  1* 

IFsl 

CALL  REArFS(A,ND,ITVPt,IERR) 

IF<I£PR.£0.LI  go  to  2!“! 

WRITE  1‘2,NT 

FORMAT  (••  ENTER  •‘.A^,**  MODEL  FROM  TERMINAL  (V  OR  Nt  >“» 

READ  ill, IANS 
IPdANS.tO.NOI  GO  TO  15 
IFs2 

DO  12  1=1, NOM 

W'lTE  112,IN0(I,ITY»£) 

FORMAT  (•*  ENTER  -,A2,“  >*•) 

REAO*,NC(I) 

GO  TO  2:i 
IFs3 

Ic^(ITYP£-2)  16,17,18 
CALL  OSNOINOI 
GO  TO  2 
CALL  CMOO(NO) 

GO  TO  E** 

CALL  TRTHOCNDI 
IFfNOdt.GT.C  )  GO  TO  EM 
WRITE  114, NT 

FORMAT  ("f**,A7,"  MOOtL  SUBROUTINE  NON-EXISIENT“l 
GO  TO  5 

IF(ITYP£-2»  21,22,23 
CALL  CSNOM(NO,NAO) 

GO  TO  25 

CALL  CMODM(NO,NADt 
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GO  TO  25 

23  CALL  TRTHCM(NC»NA0) 

25  IFILABORT.EQ.j}  60  TO  26 
WRITE  r3tNT«LA50RT 

103  FORMAT  ^••MNSUFFICI£NT  HtMORY  FOR  ".A7,-  MODEL#  NctOI  ".ID 
RETURN 

26  Ldlsl 

DO  3.  Is2#NAR 

3n  L(I)>L (I-l}«NA0(I-l#ll*NADlI-i.2) 

Ni>NT5=L(NARl»NAD(NAR«l}«NA0(NAR«2)-l 
IF(NPNTS#LE.NVSN)  GO  TO  34 
WRITE  l''4,NPNTS 

I'L  FORMAT  CV  INSUFFICIENT  MEMORY  /SYSMTX/,  NEEOl  “.ID 
LA80RT*NPNTS 
RETURN 

34  IP(IF-2)  75.35. 5u 

35  17*1 

00  4^  1*1. NAR 

Nl*Nfl0(I,lJ 

N2*NA0fI«2) 

IFIfNl.EO.v'l  .OR.(N2.EQ.C))  GO  TO  Lf 
WRITE  113.NHAT{I,ITYPE) 

1a3  format  (“i.iNTER  ".Aa) 

CALL  ZMATINCAiLtDI  .Ni.N2.IZ) 

4^  CONTINUE 
GO  T9  75 

51  CALL  ZPAF7(A.l,NPNTS.l) 

IPCITYPE-2)  55.60.65 

55  CALL  0SNMtA(L(l))«A(L(2))  .AfLf3)).A(Lf<.))  .A  f  L  f  5) )  .  A  (Lf  6 )  >  .A  (L  ( 7) ) . 
1  AfL<d))  «  A(L(9)  )  .AfLfi?)).AfLfll)>.AfL(i2))  »  A  (L  C13 )  )  *A  f L  (  aD  ) ) 

GO  TO  75 

6'  CALL  CM9M(A(L(l)).AfL(2)).A(L(3))  .AfL(4))) 

GO  TO  75 

65  CALa  TRTHHfA(L(l)).AtLf2)).ACLC3)>.A(LfD).A(L(5)),0(L(5l  )» 

1  A(L(7))  .A(L(S)  )  ) 

75  17** 

77  WRITE  r5 

LI'S  FORMAT  CT  »'OOIPY  MATRIX  ELEMENTS  <Y  OR  N)  >") 

READ  111. IANS 
IP(IANS.EO.NO)  GO  TO  «: 

WRITE  i:6,<NMAT<I.ITYPE) .1*1. NAR) 

106  F0RMAT<iX,14<2X.A3) ) 

78  WRITE  107 

ir7  FORMAT C"  ENTER  MATRIX  NAME  >") 

READ  ill. IANS 
00  Sr  1*1, NAR 

IFCIAKS.EQ.NKATd.ITYPE))  GO  TO  81 
8**  CONTINUE 
60  TO  78 

81  WPITE  lie 

lie  FORMAT!"  LIST  MATRIX  TO  TERMINAL  CY  OR  N)  >") 
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READ  lll.IANS 
XFfZAKS.EQ«NOI  GO  TO  *3 

CALL  HATLST(A(L(I1} •NAOfI«l) • NAD (I, 2 ) » NMAT( I t ITYP£ 1 t KTERH) 
63  CALL  ZHATlNUCLIin  tNAO(Itl)  •NA0(Z»2>,IZ) 

GO  TO  77 

91  IP(IH?T»  95,92, 93 

92  IWRT=1 

93  MPITE  115, NT 

115  format  ("r  WRITE  ••,A7,~  MODEL  TO  'SAVE*  FILE  (Y  OR  N)  >”» 
READ  111, IANS 
IF(IAKS,E0*N01  go  to  95 
call  WFIL€0(ITVP£,NPNTS,N0,A) 

IWRT=-1 
W  =  ITE  lf9,NT 

1*9  F0R*1AT(6X,A7,"  MODEi.  WRITTEN  TO  *SAVE*  FIlE") 

95  DO  13.  1=1, NAR 
Nl=NAO(T,l) 

N2=NAD(I,2I 

IFI(Ni.EO.t.).OR.(N2.EO«'*))  GO  TO  IL 

CALL  MATLST<A<L(I)I  ,N1,N2,NMATII,ITV0£)  ,Kj.isT) 

CONTINUE 
111  F0RMA'^(A51 

RETURN 

C  END  SUBROUTINE  RSYS 
END 


SUBROUTINE  DSND(ND) 
DIMENSION  N3<1> 
NPClIs’ 

RETU'fN 

C  ^NO  SUBROUTTN’’  DSND 
END 
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SUBROUTINE  CN3D(N0) 
OIHENSION  NOdI 
ND(1»=C 
RETURN 

C  ENO  SUBROUTINE  CMOD 
END 


SUBROUTINE  TRTHO(NOI 
OINENSION  NO(l) 
NO(ll=' 

RETURN 

C  ENO  SUBROUTINE  TPTHO 
END 


StJBROUTIN*^  DSNNf A,a,EX,G,Q,Ct0y»Ey»H,HDtR.AD.6D,0DI 
RETURN 

C  END  SUBROUTINE  DSNH 
END 


SUBROUTINE  CMDH ( AN, BM ,CMf OH» 
R-TU^N 

C  END  SUBROUTINE  CMD^ 

END 
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SU3»0UTINc  TRTHH«Ar,BT,6T*QTtHT,RT,TDT,TNT) 
RETIPN 

C  END  SUaROUTINP  TRTHH 
END 


SUBROUTINE  DSNDICNOtNAO) 

COHMON/OE  SXGN/NVC0H,TSAHP,I.FLRPI,4.FLCGTtLfLKF,LTEVAL,LA30RT 
cohmon/ncthd/nno«n»o,npc»nhd.noo.nwo,nh!:o.nplc,nmpnwd»nnpr 
COHHON/DSNrtTX/N>/aff,NOOV,NOEY,OH(l) 
ni«£NS10N  NOd)  ,NA0C1A,2) 

NN0=N0(1I 

NRQsNri?) 

NP0s»40(?l 

n«c*noC4» 

NOO=MD  f5) 

NN0sNC(6> 

NW00sN0(7I 

NPLO=NNO+NOO 

NMPNNO^NWO't’NMDO 

NNPRsKKQ+NRO 

NSOdtllsNWD 

NAD(2,l)*NNO 

N80<3»i»*NN0 

NAD(4«l}sNN0 

NAD(5tH»K’W0 

NA!3(6,l>=NPO 

NAOC^f  1)  =  NPD 

NAO<S,llsNFO 

NAO(o.I)*NMD 

NAOCi^ ,l)sNHD 

NAD<ll»ll*NHO 

NA0(i2«l) «NOO 

NAD<l3,l)*NOO 

NA0li4*l) *NMOO 

NA0(1.2I  =  NN0 

NAOC2»2)  =  NRD 

NA0(7,2)aN00 

NAO(b,2)sNND 

NA0(3»2)aNH0 

NA0(6»2I*NND 

NAOCr.aisNPO 

NAt)(9t2)sN00 

NA0(9»2}aNN0 

NAOCi'.  .aiaNOD 

NAO(llt2)aNHO 

NA0(12f2)aN0D 

NAO(13,2)aNHCD 
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NA0(1U,2) «NHDO 

NSIZE*NPL  C*I2*NPL0*NND^NHD+NPD^NHPNM0)  ♦NftO*  (NNO*NPD)  ♦ 
1  NOO*NOO-*-NHO*NHQ«-NWQ«NVfD-fNHOO«NMOO 
IFfNSIZP.6T«N\/0H|  LABOPTsnSZZE 
RETURN 

C  EKO  SUBROUTINE  OSNOM 
END 


SUBROUTINE  CMDOMf NO«NAO) 

COMNON/NOTMC/NNC,NRC,N»C 

COMHON/CMCPTX/NVCM,NZ«CM.NOrC»CM(l) 

COHMON/OESIGN/NVCOM,TSA»iP,LFLRPI,LFLCGT,LFLKF,LTEtfAL,LA30RT 
DIMENSION  N3(i) ,NA0(14,2) 

NNC*ND(1) 

N^CsNCCZ) 

NOC=MOC3» 

NAC(1«1)-NNC 
NAOI?«  lIsNNC 
NA0(3*11*NPC 
NAOlfctUsNPC 
NAOd,  2I*NNC 
NA0<2,2)*NRC 
NA0(3,2)*NNC 
NAC(A,2)xMRC 

NSIZ'a  NNC*  <NNC*  NRC+NPO  ♦NPC*NRC 
IFCNSIZi.GT.NVCM)  LA30RT=NSIZE 
RETURN 

C  END  SUBROUTINE  CM30M 
END 
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SUBROUTINE  TRTHONfNOtNAO) 

COHHON/OESIGN/NVCOM,TSAHP,LFLRPItLFLCGTyLFL<F,LTEVAL»L 

COHHON/NriMO/NNO.NROvNOOtNNOtNODtNMOtNHCDtNOLOtNMPNUOf 

C0HH0N/N01MT/NNT,NRT,NHTtNMT 

COHHON/TP  UMTX/N  VTM, TH (1 1 

DIMENSION  NOfl» tNAOI14»2> 

NNTsND(l) 

NRT»N0(2» 

NMT*ND(3» 

NHT=NP«*I 

NAOIlyDsNNT 

N40(2,1»=NNT 

NA0C7.1»sNNT 

N40Ci»»ll  =  NWT 

NSDCE.DsNMT 

NaD(6«l)sNMT 

NaO(7.1»  =  NND 

NAOCayDsNOO 

NaDll,2)  =  NNT 

NAD(2,2I  =  NRT 

NaO(3,2»=NWT 

NA0(U,2)£NHT 

NA0(5,2)  =  NNT 

NAD(6,2>*NMT 

NADC?,2>sNNT 

NA0(S«2)sNNT 

NSIZEsNNT*<2*NNT*NM0*NRC+NPL0)*NMC*NMD 
1P(NSIZE.GT,NVTM)  lABORTsNSIZE 
R'TU'^N 

tNC  subrouttne  TRTHOM 
END 


ABORT 

NNPR 


S'JOROUTINF  ZMATIN(A.NR,NC»IZ> 
DIMENSION  A(NR,NC) 

I«^IIZ)  ICylii.l 
DO  5  1=1, NR 
DO  5  J»1,NC 
A(i,ji=:. 

WRITE  1?1,NR,NC 
R"AD*,I,J,ir 
IFII.EQ.'’)  RETURN 

IFf  tl.LE.NRI.AND.fJ.LE.NO)  GO  TO  2 
WRITE  I’E 
GO  TO  U 
Aa,JI=V 

IF(I7.LT.»)  AfJ,I)=V 
GO  TO  15 
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ENTER  ItJ  AND  >CP/  WHEN  COMPLETE)  I  “IZt 


in  FORMAT  (•• 

1  “  >•') 

152  FORMATf  ERROR  IN  ARRAY  IN0EX“) 
C  END  SUBROUTINE  ZHATIN 
ENO 


SUBROUTINE  HFIL£OINT»MP,ND, A) 
COMMON/FILES/<SAVEfKOATA,KPLOT,t(LIST,KTERN 
OIMENSICK  NOdL;)  fAtNO) 

DATA  IEOI/-1/ 

BACKSPACE  KSAVE 
WPITE{KSAVE»11H  NT,NP 
M31Tc(K3AV£tl‘’l.)  INOf  I)  tl*!.  1.  ) 
WPlTc(KSAV£«152l  (A (I > » 1*1, NP> 
W1ITE(KSAVF.1>)1)  IEOI,NP 
R-TUon 

1.1  FORMAT (214) 
m  FORMAT  lEEi  .!•  ) 

C  ENO  SUBROUTINE  HFILEO 
ENO 


subroutine  REA0FS(A,ND,NT,I£RP) 
COMMON/FILES/KSAV£,KOATA,KPLOT,KLIST,KTrRrt 
OIMENSION  A(l)  ,NO(i»'  ) 

DATA  IEOI/-1/ 

R-rwiNO  KDATA 

5  READ(KOATA,ir2)  IT,NP 

IFd’-.NE.IEOI)  GO  TO  1.' 

waiTE  m 

I'^RR*! 

return 

CALL  FARRAY(A,NO,NP) 

IF(IT.NE.NT)  GO  TO  5 
I  “  RR* 

1-1  FORMATC'C  CATA  NOT  IN  'DATA*  FILE  .  .  .") 
1P2  F0RMAT(?I4) 

RETURN 

C  END  SUBROUTINE  READ^S 
ENO 


*  __  i - 


SUai^OUTINF  FA<?JlAVfA,ND,»IP) 
C0Nt10N/FILc;S/KSAtf£,K0ATA,KPL0T,<LIST,KTERM 
OIHENSIOK  A(NP)  •NOIl'') 

P"AD(KOATA,iri»  INOII»tI*l»lC» 
P£A0(KDATA,1P2I  I  Ad)  «Z=ltNP) 

RETUPN 

I"!  F0Rt1ATC2I4) 

VZ  FORMAT  (EZr.l!  ) 

C  ENO  SUBROUTINE  FARRAY 
ENO 


SUBROUTINE  TFRHTX (XI, X2, NR. NCt ITX) 

COMMON/MAINl/NOIM 

DIMENSION  Xl(l) ,X2(1> 

ir{TTX,EQ.2)  GO  TO  Zi 

J=NC*NCIH 

K<=-3 

00  ir  I=1.J,NDIM 

L=I+NR»1 

DO  !'■  JJsIvt 

K<sKK*l 

XI (KK)*X2 <JJ) 

R"  TUTN 

2'  KKaNR*NC*l 

DO  3^  1*1, NO 
L=(NC-I)*NDI*1t1 
DO  3-  J=1,NR 
KK=K<-1 
JJsL+NR-J 

3'  X2( JJ)=Y1<KK) 

RETUtJN 

ENO 
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SUBROUTINE  HATLST(A*NR,NC*NT«KDEV) 
OIHENSION  AfNR,NC) 

MRITE(KOEV,ltlI  NT 
00  ±r  I»1,NR 

1C  MPITEfKDEV.lCZI  I  A{  I,  Jl  tJ*!,  NO 
IPl  FORMAT  (IH.:, A3  i“  MATRIK**/| 

1<'2  FORMAT  (iXlPlwG13.4t 

RETURN 

C  END  SUBROUTINE  MATLST 
END 


SUBROUTINE  NOSCRT(A,N,NTFRMS> 

COMMON/DE ?IGN/NVC0M,TSAMP»LFLRPI,LFLCGT,LFLKF,LTEVAL*L ABORT 
DIMENSION  A(i) 

NTERvS=IFIXCe.*3.*TSAMP*XN0RM<N, A») 

IFINTERMS.GT.  1».»  NTERMS=3l. 

RETURN 

C  ENO  SUBROUTINE  NOSCRT 
ENO 


SUBROUTINE  RQWGTS CMf NC,NP) 

DIMENSION  H(ll 

I**  W^iTE  i:i 

i'l  FORMAT!”  ENTER  I  AND  OHIIfll  — Cr*/  WHEN  COMPLETE!  >”) 

15  R"AO*,IfV 

IFd.EQ.fJ  RETURN 
IFII.LE.NC)  GO  TO  2' 

MPITE  1'‘2 

I'’ 2  FORMAT!"  ERROR  IN  ARRAY  INDEX") 

GO  TO  1" 

2i  IF!V)  25,3C,4". 

25  H=ITE  1^3 

1'53  FORMAT!"  ELEMENTS  MUST  BE  NON-NEGATI VE"> 

GO  TO  15 

3?  IF!NP)  l5»Mr!,35 

35  WRITE  lEL 

1P4  FORMAT!"  ELEMENTS  MUST  BE  POSITIVE") 

GO  TO  15 

40  Ll*LAOOR!NO«IfI) 

M!Ll)sV 
GO  TO  15 

C  ENO  SUBROUTINE  RQHGTS 
ENO 
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SUBROUTINE  D»CTOR(N,«,tfl 

OINENSICN  A(il,V(il 

N»1*N*1 

N?*N*N 

J=? 

DO  I=1»N2»NP1 
J=J+1 

ir  v<jtsA(i) 

R’^TU^N 

C  FNC  SUBROUTINE  OVCTOR 
END 


SUBROUTINE  P0LES(A,N,ITYPE,ZM1*7M2» 
CCHNON/MAlNl/N3IM»NOIHi,COHl (1» 

COMMON/OESIGN/NVCOH,TSAMP,LFLRPIfLrLCGT,LfLKF,LTEVALtL ABORT 

COMMON /FILES/<SAV',KOATA,KPLOT.KL 1ST .KTERh 

DIMENSION  NTYP(5I « A (1) •ZMl til ,ZM2 (1 > 

data  NTYP/6HDESIGN,7HC0MrtAND.5HTRUTH,5HR£&PI,6HFItTEF./ 

NOS=NDIM 

NOIMsN 

NDIMlsNOIH+l 

CALL  EIGENINDIM,A,ZHl,ZMifNOIHl> ,ZMc,') 

IPtITYPc,LT,4l  GO  TO  Vj 
CALL  HAPOLEtN,ZMl,ZMHNClMl)  ,TSAMP| 
i;  HRITECKLISTtlJZJ  NTYPtITYPEI 
HEITt.(KT£FM,ll2>  NTYPtITYPEI 
HRITE(KLIST,1C1)  tZMl tl I ,ZM1 tNDIMtII yl^ltNI 
HRITEtKT£FM,l;,ll  tZMi  tl)  ,ZH1  tNOIM^J  I  ,1^1  ,n) 

N0IM=N0S 
NOIMl  =  NDTMn 

1^1  F0RMATt6X,lP£15,7***  ♦J  f,lPE15.  7,-) -| 

i"2  FORMAT  ffPOwES  OF  -,A7,~  MATRIX-/) 

RETURN 

C  FNO  SUBROUTINE  POLES 
END 
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SUBi^OUTlWr  HA»0L£CN,Z«,ZI,T» 
OIHENSION  ZRIilvZZfll 
RT«1,/t 
DO  1*J  1*1  »N 

ZM»S0RT<ZRIII  ••2*ZX  CH**2I 

SIGHA*RT*ALOG(Z*1) 

ZX<I)«RT«ATAN2fZl(ZI 

Zix(I)«SI6MA 

RFTURN 

C  EKO  SUBROUTINE  MAPOL" 

ENO 


function  LA00R(NR,I,J» 
LAOOR=I^Nc*(j-i) 

return 

C  £NO  function  laddr 

CMQ 


subroutine  FTNTXf)(,V,NR,NC) 
OIHENSION  Xdl.Ytll 
NEaNR*NC 
00  l;  1*1, N£ 

I**  Yai=x<i) 

R“TU=N 

C  END  SUBROUTINE  FTMTX 

Evn 


SUBROUTINE  FHMUL(X,V«NRl,NCi«NC2«Z) 
OXHENSXON  X(NRitNClltYfNCi«NC2) tZ(N^ltNC2) 

double  precision  to 

DO  15  I*l,NRl 
DO  18  J«1,NC2 
TOaJ.Oa" 

DO  5  K*1,NC1 
5  TO=TO*X(I,K»*Y(X,  J» 

1^  ZCI,J»sTD 
RETURN 

C  END  SUBROUTINE  FHNUL 
END 


SUBROUTINE  ^THUL t X, V , NRl.NCl tNCg ,2) 

OINENSION  X(NR1«NC1} • Y( NR1,NC2>  t Z (NC1» NC2> 

DOUBLE  PRECISION  TD 

00  1'  1*1, NCI 

DO  i'  J=1,NC2 

TO*-.',  COi 

00  5  K*1,NR1 

5  TDsTO*X<K,II*Y(  K,  J» 

I-"  z<r,ji*ro 

RETURN 

C  END  SUBROUTINE  FTNUL 
ENO 


SUBROUTINE  FMADOf X,V,NR,NC,Z) 
dimension  X«1»,YU)»Z<1) 
NEaNR*NC 
00  I**  1*1,  N£ 
ir  z(Ii*xii)«y(I) 

RETURN 

C  END  SUBROUTINE  FHADD 
END 
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SUBROUTINE  ZPARTf A, NR,NC*NO) 
DIHcNSION  A(ll 
NE*NC*ND 
DO  i'J  I«1«NR 
DO  ir  JxI,nE«NO 
If  AU)=f. 

RETURN 

C  ENO  SUBROUTINE  ZPART 
END 


SUBROUTINE  SUBI (A«NR,NO) 
DIMENSION  fl(l» 

NBlsND^l 
NEsNP*ND 
DO  1'  I»1»NE,N01 
If  A(1»=A(II-1, 

RETURN 

C  END  SUBROUTINE  SUBI 
ENO 


SUBROUTINE  HPL0TF(V«N) 

C0MM0N/RIL£S/<SAVE,KDATA,KPL0T,KLIST,<T£RM 
DIMENSION  V(NI 

HRITE<KFLOT,lll)  (V(I)«Ixl«N) 

RETURN 

IM  FORMAT  (EZt.r,) 

C  END  SUBROUTINE  WPLOTF 
ENO 


ooooooooooooooooono 


SUBROUTINE  RP4.0TFIV,N,I£RR) 
COHMON/FILES/KSft»/EtKOATA,KPLOT,KLIST,KT£RH 
OINENSION  V(N) 

RcAD*KPLOT,ltl»  «V(I),Isl,N) 

IF(EOFIKPLOT))  5,1'' 

5  lERRsl 
RETURN 
1C  I'RRs? 

RETURN 

IM  FORMAT  (E2a.lL  I 
C  END  SUBROUTINE  RPLOTF 
ENO 


SUBROUTINE  STRPLT < A , V .NS. NV, NP. NVO> 
DIMENSION  A(ll«NS<lt«NV(il (1) 
A(NS(ill=V(NVO) 

00  5  1*1, NP 

5  AfNS(I*l  n*VtNV(in 
RETUFN 

C  END  SUBROUTINE  STRPLT 
END 


SUBROUTINE  PL0TLP(N,M,A,IPSC,ISCL,LPT£RM,NDEV.ITITLE> 


N  *  NUMBER  OP  POINTS  TO  Pc  PLOTTED 
M  =  NUMBEP  OF  OUTPUTS  TO  BE  PLOTTED 

A  *  VECTOR  OF  SAMPLE  POINTS  FOR  PLOTTING  I  DIMENSION  *  N*M 
ELEMENTS  1  TO  N  ARE  THE  INDEPENDENT  VARIABLE 
ELEMENTS  CN^ll  TO  2*N,  (2*N*1I  TO  3*N,  AND  SO  ON  ARE 
THE  DEPENDENT  VARIABLES— EACH  VARIABLE  IS  IN  CONSECUTIV 
STORAGE  WITH  CORRESPONDING  SAMPLE  POINTS  FOR  EACH 
SEPARATED  BY  MULTIPLES  OF  N 
IPSC  *  -i  s>  scale  all  variables  together  (x  PLOTI 

*  n  S>  SCALE  TOGETHER  AND  SEPARATELY  (2  PLOTS) 
a  ♦!  *>  SCALE  SEPARATELY  II  PLOT) 

ISCL  a  :>  *>  PLOT  OVER  EXACT  RANGE  OF  VARIABLE 
a  1  a>  plot  using  even  SCALING 
LPTERM  s  f  s>  plot  IS  TO  TERMINAL  (5C  CHARACTERS  MICE) 

a  1  a>  PLOT  IS  TO  LINE  PRINTER  (11'  CHARACTERS  HIDE) 
NOEV  a  device  NUMBER  FOP  PLOT  OUTPUT 

ITITLE  a  VECTOR IDIHENSICNEO  5)  HITH  5'  CHARACTER  TITLE 


OINENSION  YSCAL(6»,YNIN(6),IBLNK(&) ,YPR(1«) , A (1) 


INTEGER  OUTtlSl) tSYHBOL (61 ,BLANK«PLUStGRlUt ITITL£<5I 

DATA  BLAKK,PLUStCOLON»SVMBOL/lH  •IHl-tlHt  t^HX»lH2tlH3tlH4tlHE  •IHG/ 

1  FORHATdH  } 

2  F0RHATflHl,llX,5Al!i/) 

1C  FORFATdH  •F11.2,eX,itiAl) 

12  FORHATCllH?  SCALE  * A1 ,iX, llFl^ ,4> 

IPAPERsS*  d+LPTcRH) 

ISPAC=1^*IPAPER 

RISPAC«FL0AT(ISPAC) 

lSPAC»ISPACd 

IoRTlslPAPER+1 

Rm1n=A(N+H 

RMAXsRMIN 

25  DO  41  ISC*1,M 
M1=ISC*N+1 
YLsAIHlI 
YM  =  YL 

M?*N*(ISC+1I 
DO  4“  JsMl,M2 
IF(A(J».LT.YL)  GO  TO  3'; 

IFCA<JI.GT.YH)  YHsA(J) 

GO  TO  4" 

3^  YL*A(J) 

<»*■  CONTINUE 

IP ( YL. LT. RMINI RHIN* YL 
IF<rH,6T,RHAXI  RMAXsYH 

1F(IPSC«GE«3)  CALL  tf ARSCLf YL t YH, YSCAL (ISC) *RISPAC* ISCL ) 

41  YrtiNdSCIsYL 

IFIIPSC.LE.OCALL  VAnSCL (RMIN,RHAX , 5CAL  t  RISPAC,  ISCL) 

IC*2-IABS  (IPSO 
00  45  IX=1,ISPAC 

45  OUT(IX):BLANK 
DO  1C  ;  IC0=1*IC 

HRITi(NDFV,2l  (ITITLE(I),I=lt5) 

DO  6'  1=1, N 
XORsAd) 

IP(MOO(I,li«).EQ.u)  GO  TO  456 
GRIO=BLANK 
GO  TO  46r 
456  GR1D=COLON 
4e(  00  461  IX=2,ISPAC,2 

461  OUT(lX)sGRID 

00  46  IX*l,ISPACfi: 

46  OUT(IX)=PLUS 
00  55  J=1,N 
IL*I+J*N 

IF(IPSC)  46,47,49 

47  IPSCT*IPSC+ICC 
IF(IPSCT,£Q.2)  GO  TO  49 

48  JP*IFIX((A(IL)*RMIN)/SCAL)41 
GO  TO  5'’ 


JDsIFIXnAfIL>-YHINIJ>l/YSCAL(J)Ml 
SO  OUTIJP)sSYNBOL( J) 

5F  I9LNK(JI«JP 

H»ITE(N?EV(i;)  XP»«fOUTflXI,IXcl«lSPAC) 

DO  59  J«1«M 
IT€HP=IBLNKfJ» 

59  0UT«ITEHPI»BLANK 
6?  CONTINUE 

IFCIPSCI  eet67«72 
67  IF<IPSCT*£Q.2»  GO  TO  72 
69  YPR(1I«RMIN 

DO  7j  Isl.IPAPER 
7l-  VPRII*ll*YPR{I)+l3,*SCAi. 

WRIT£(NDEV,12I  BLANK, CYPRII) ,1*1,IPRT1> 

GO  TO  in 

72  DO  7f  ISC=1,N 

YORCll sYHINCISCI 
DO  7*.  IsltlPAPER 

74  YPRCI  +  1)*YPR<I1+1.,*YSCAHISC) 

76  MPITE (N0EV,12I  SYMBOL f ISC» , I YPR( IX) » IX=l , IPRTI I 
Itf  M9ITECNOEV.1) 

RETURN 

C  SUBROUTINE  PLOTLP 

END 


SU'3R0UTINE  VARSCL(XMIN,  XHAX,  SCALE,RSPAC£  ♦  ISCL) 
IFIXMAX.EQ.XMINI  XMIN=.9*XMIN-1'' . 

SCALE=XMAX-XMIN 
IFIISCL.EO.D  GO  TO  25 
EyP=IFlXCiaC**ALOGlC  fSCALE)  )-ltL;* 

FACTORsir .♦•<1,-EXP) 

XMlNTsXMIN*FACTOR 
XHAXTsXMAX*FACTOR 
IFCXMAXT.Gt.f .)  XMAXTsXMAXT+.g 
IFCXMINT.LE,^ .)  XMINTxXMINT-.9 
XMlNTsAINTCXMINT) 

ISCALsXMAXT-XMINT 

IFfHODIISCALtSI  .NE.**)  ISCALsISCAL*5-MOD  ( ISCAL  ,  5 1 
FACTORal':  .*•1  sXP-l.) 

XI1IN=XMINT»FACTOR 

SCALF*FACTOR*FLOATIISCAL) 

25  SCALE«SCALE/RSPACE 

retup.n 

C  END  SUBROUTINE  VARSCL 
END 
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Appendix  E 

CGTPIF  Segmentation  Job  Control 

The  following  listing  shows  the  job  control  com¬ 
mands  and  segmentation  directives  used  in  obtaining  a 
segmented  object  file  suitable  for  interactive  execution 
on  the  CDC  CYBER  computer  system.  The  job  employs  three 
object  files:  "L",  "S",  and  "A".  The  routines  on  each  of 
these  files  are  (see  the  program  description  and  listing 
of  Appendices  A  and  D,  respectively) , 

"L":  'MAIN'  and  all  optional  routines  ('MAIN'  through 
'TBLUPl') 

"S":  'CGTPIF  SUBS’  ( 'CGTXQ'  through  'VARSCL') 

"A":  'LIBRARY' 

Object  files  L  and  S  are  loaded  into  memory  in  order  of 
MAIN  then  CGTPIF  SUBS.  The  "NOGO"  command  then  cornpletes 
the  load  from  LIBRARY  and  system  routines  in  order,  but 
does  not  initiate  execution.  Next,  the  segmentation 
directives  are  executed  (segmentation  directives  appear 
between  the  pair  of  ''*EOR''  lines) .  When  segmentation  is 
complete,  the  resulting  object  file  is  cataloged. 

In  this  listing,  the  names  given  the  various  object 
files  ("L",  "S",  "A")  are  arbitrary,  and  the  "ATTACH" 
commands  may  occur  in  any  order.  The  file  name  ("Ifn") 
given  in  the  "LIBRARY,  Ifn"  command  must  correspond  to  the 
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name  used  in  attaching  the  object  file  of  'LIBRARY* 
routines  ( "A”  in  this  case) .  The  name  given  to  the  seg¬ 
mented  object  file  is  arbitrary  CCGTPIF"  in  this  case) 
but  must  be  consistent  in  the  "REQUEST",  "SEGLQAD",  and 
"CATALOG"  commands.  The  segmentation  directives  should 
not  be  modified  in  any  way. 

As  done  in  this  case,  it  is  convenient  to  maintain 
distinct  object  files  for  each  of  the  three  sets  of 
routines.  Thus  both  'CGTPIP  SUBS'  and  'LIBRARY'  remain 
invariant  in  object  and  LIBRARY  object  files,  respectively. 
The  routine  'MAIN'  and  any  desired  user-provided  optional 
routines  may  then  be  developed  as  an  independent  set,  and 
compiled  to  obtain  the  needed  c^ject  file.  Descriptions  of 
'MAIN'  and  optional  TOUtines  are  given  in  the  "Programmer's 
Guide"  (Appendix  A) . 


R-IP.  D790477,  FLOYD 
MAP,  FULL. 

ATTACH, L, SEQUENT,  CY«10. 

ATTACH, S, FLOYDLl,  CY»10. 

ATTACH, A, FLOYDLl , CY«1 . 

LIBRARY, A. 

REQUEST, CGTPIF,  *PF. 

SEGLOAD ( B=CGTPIF ) 

LOAO(L. S) 

NOGO. 

CATALOG, CGTPIF, THESIS, CY-100, RP«iaO,  PH=R IF. 

*EOR 

SETUP  INCLUDE  DSCRT 

SREGPI  INCLUDE  RQWGTS, MLINEQ, FACTOR 

FLTRK  INCLUDE  RQWGT3, KFLTR.MLINEQ,  FACTOR,  INTEG 

STRTH  INCLUDE  D3CRTT, INTEG 

SDSN  INCLUDE  QDSCRT 

CEVAL  INCLUDE  PLOTLP, VARSCL, RPLOTF, HPLOTF, STRPLT 

FEVAL  INCLUDE  PLOTLP, VAKSCL, RPLOTF, HPLOTF, STRPLT,  DACOV 

B1  TREE  SETUP-(SDSN,SC-1D,  STRTH) 

B2  TREE  PIMTX 

B3  TREE  SREGPI 

B4  TREE  SCGT 

liS  TREE  CEVAL 

Bo  TREE  FLTRK 

D7  TREE  FEVAL 

A  TREE  CGTXQ-(B1,B2,B3,B4,  D5,B6,B7) 

ROOT  TREE  -I AIN- A 

GLOBAL  i‘lAINl,MAIN2,  INOU,  DESIGN,  FILES,  SYSMTX,  ZMTXl,  ZMTX2, 

,  NDI.’ID,  LOCD,  DSN'ITX,  NOI  -IC,  LOCC,  C-1D4TX,  NDIAT,  LOCT,  TRUHTX,  LCNTRL,  CONTROL. 
, LREGPI , CREGPI , LCGT, CCGT, LKF, CKF 
END 

*EOR 

*EOF 
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